mirrors/monado
1
0
Fork 0
mirror of https://gitlab.freedesktop.org/monado/monado.git synced 2025-01-06 07:06:10 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

d/nreal_air: Tidy [NFC]

Browse source
This commit is contained in:
Jakob Bornecrantz 2023-10-18 17:28:24 +01:00
parent 8279441486
commit 8110fceb39
1 changed files with 29 additions and 13 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

42
src/xrt/drivers/nreal_air/na_packet.c
View file

@ -14,19 +14,20 @@
#include <cjson/cJSON.h> #include <cjson/cJSON.h>
#include <string.h> #include <string.h>
/* /*
* *
* Helper functions. * Buffer reading helpers.
* *
*/ */
inline static void static inline void
skip(const uint8_t **buffer, size_t num) skip(const uint8_t **buffer, size_t num)
{ {
*buffer += num; *buffer += num;
} }
inline static void static inline void
read_i16(const uint8_t **buffer, int16_t *out_value) read_i16(const uint8_t **buffer, int16_t *out_value)
{ {
*out_value = (*(*buffer + 0) << 0u) | // Byte 0 *out_value = (*(*buffer + 0) << 0u) | // Byte 0
@ -34,7 +35,7 @@ read_i16(const uint8_t **buffer, int16_t *out_value)
*buffer += 2; *buffer += 2;
} }
inline static void static inline void
read_i24_to_i32(const uint8_t **buffer, int32_t *out_value) read_i24_to_i32(const uint8_t **buffer, int32_t *out_value)
{ {
*out_value = (*(*buffer + 0) << 0u) | // Byte 0 *out_value = (*(*buffer + 0) << 0u) | // Byte 0
@ -45,7 +46,7 @@ read_i24_to_i32(const uint8_t **buffer, int32_t *out_value)
*buffer += 3; *buffer += 3;
} }
inline static void static inline void
read_i32(const uint8_t **buffer, int32_t *out_value) read_i32(const uint8_t **buffer, int32_t *out_value)
{ {
*out_value = (*(*buffer + 0) << 0u) | // Byte 0 *out_value = (*(*buffer + 0) << 0u) | // Byte 0
@ -55,7 +56,7 @@ read_i32(const uint8_t **buffer, int32_t *out_value)
*buffer += 4; *buffer += 4;
} }
inline static void static inline void
read_i16_rev(const uint8_t **buffer, int16_t *out_value) read_i16_rev(const uint8_t **buffer, int16_t *out_value)
{ {
*out_value = (*(*buffer + 1) << 0u) | // Byte 1 *out_value = (*(*buffer + 1) << 0u) | // Byte 1
@ -63,7 +64,7 @@ read_i16_rev(const uint8_t **buffer, int16_t *out_value)
*buffer += 2; *buffer += 2;
} }
inline static void static inline void
read_i15_to_i32(const uint8_t **buffer, int32_t *out_value) read_i15_to_i32(const uint8_t **buffer, int32_t *out_value)
{ {
int16_t v = (*(*buffer + 0) << 0u) | // Byte 0 int16_t v = (*(*buffer + 0) << 0u) | // Byte 0
@ -73,7 +74,7 @@ read_i15_to_i32(const uint8_t **buffer, int32_t *out_value)
*buffer += 2; *buffer += 2;
} }
inline static void static inline void
read_i32_rev(const uint8_t **buffer, int32_t *out_value) read_i32_rev(const uint8_t **buffer, int32_t *out_value)
{ {
*out_value = (*(*buffer + 3) << 0u) | // Byte 3 *out_value = (*(*buffer + 3) << 0u) | // Byte 3
@ -83,14 +84,14 @@ read_i32_rev(const uint8_t **buffer, int32_t *out_value)
*buffer += 4; *buffer += 4;
} }
inline static void static inline void
read_u8(const uint8_t **buffer, uint8_t *out_value) read_u8(const uint8_t **buffer, uint8_t *out_value)
{ {
*out_value = **buffer; *out_value = **buffer;
*buffer += 1; *buffer += 1;
} }
inline static void static inline void
read_u16(const uint8_t **buffer, uint16_t *out_value) read_u16(const uint8_t **buffer, uint16_t *out_value)
{ {
*out_value = (*(*buffer + 0) << 0u) | // Byte 0 *out_value = (*(*buffer + 0) << 0u) | // Byte 0
@ -98,7 +99,7 @@ read_u16(const uint8_t **buffer, uint16_t *out_value)
*buffer += 2; *buffer += 2;
} }
inline static void static inline void
read_u32(const uint8_t **buffer, uint32_t *out_value) read_u32(const uint8_t **buffer, uint32_t *out_value)
{ {
*out_value = (*(*buffer + 0) << 0u) | // Byte 0 *out_value = (*(*buffer + 0) << 0u) | // Byte 0
@ -108,7 +109,7 @@ read_u32(const uint8_t **buffer, uint32_t *out_value)
*buffer += 4; *buffer += 4;
} }
inline static void static inline void
read_u64(const uint8_t **buffer, uint64_t *out_value) read_u64(const uint8_t **buffer, uint64_t *out_value)
{ {
*out_value = ((uint64_t) * (*buffer + 0) << 0u) | // Byte 0 *out_value = ((uint64_t) * (*buffer + 0) << 0u) | // Byte 0
@ -122,13 +123,20 @@ read_u64(const uint8_t **buffer, uint64_t *out_value)
*buffer += 8; *buffer += 8;
} }
inline static void static inline void
read_u8_array(const uint8_t **buffer, uint8_t *out_value, size_t num) read_u8_array(const uint8_t **buffer, uint8_t *out_value, size_t num)
{ {
memcpy(out_value, (*buffer), num); memcpy(out_value, (*buffer), num);
*buffer += num; *buffer += num;
} }
/*
*
* JSON helpers.
*
*/
static void static void
read_json_vec3(cJSON *object, const char *const string, struct xrt_vec3 *out_vec3) read_json_vec3(cJSON *object, const char *const string, struct xrt_vec3 *out_vec3)
{ {
@ -187,6 +195,13 @@ read_json_array(cJSON *object, const char *const string, int size, float *out_ar
} }
} }
/*
*
* Helpers.
*
*/
static void static void
read_sample(const uint8_t **buffer, struct na_parsed_sample *sample) read_sample(const uint8_t **buffer, struct na_parsed_sample *sample)
{ {
@ -212,6 +227,7 @@ read_sample(const uint8_t **buffer, struct na_parsed_sample *sample)
read_i15_to_i32(buffer, &sample->mag.z); read_i15_to_i32(buffer, &sample->mag.z);
} }
/* /*
* *
* Exported functions. * Exported functions.