123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449 |
- #ifndef APP_UTIL_BDS_H__
- #define APP_UTIL_BDS_H__
- #include <stdint.h>
- #include <string.h>
- #include <stdbool.h>
- #include "compiler_abstraction.h"
- #include "app_util.h"
- #include "ble_srv_common.h"
- #include "nordic_common.h"
- #ifdef __cplusplus
- extern "C" {
- #endif
- typedef uint8_t nibble_t;
- typedef uint32_t uint24_t;
- typedef uint64_t uint40_t;
- typedef struct
- {
- uint8_t * p_list;
- uint8_t list_len;
- } regcertdatalist_t;
- typedef struct
- {
- int8_t exponent;
- int16_t mantissa;
- } sfloat_t;
- typedef struct
- {
- uint16_t year;
- uint8_t month;
- uint8_t day;
- uint8_t hours;
- uint8_t minutes;
- uint8_t seconds;
- } ble_date_time_t;
- static __INLINE uint8_t bds_uint16_encode(const uint16_t * p_value, uint8_t * p_encoded_data)
- {
- p_encoded_data[0] = (uint8_t) ((*p_value & 0x00FF) >> 0);
- p_encoded_data[1] = (uint8_t) ((*p_value & 0xFF00) >> 8);
- return sizeof(uint16_t);
- }
- static __INLINE uint8_t bds_int16_encode(const int16_t * p_value, uint8_t * p_encoded_data)
- {
- uint16_t tmp = *p_value;
- return bds_uint16_encode(&tmp, p_encoded_data);
- }
- static __INLINE uint8_t bds_uint24_encode(const uint32_t * p_value, uint8_t * p_encoded_data)
- {
- p_encoded_data[0] = (uint8_t) ((*p_value & 0x000000FF) >> 0);
- p_encoded_data[1] = (uint8_t) ((*p_value & 0x0000FF00) >> 8);
- p_encoded_data[2] = (uint8_t) ((*p_value & 0x00FF0000) >> 16);
- return (3);
- }
- static __INLINE uint8_t bds_uint32_encode(const uint32_t * p_value, uint8_t * p_encoded_data)
- {
- p_encoded_data[0] = (uint8_t) ((*p_value & 0x000000FF) >> 0);
- p_encoded_data[1] = (uint8_t) ((*p_value & 0x0000FF00) >> 8);
- p_encoded_data[2] = (uint8_t) ((*p_value & 0x00FF0000) >> 16);
- p_encoded_data[3] = (uint8_t) ((*p_value & 0xFF000000) >> 24);
- return sizeof(uint32_t);
- }
- static __INLINE uint8_t bds_uint40_encode(const uint64_t * p_value, uint8_t * p_encoded_data)
- {
- p_encoded_data[0] = (uint8_t) ((*p_value & 0x00000000000000FF) >> 0);
- p_encoded_data[1] = (uint8_t) ((*p_value & 0x000000000000FF00) >> 8);
- p_encoded_data[2] = (uint8_t) ((*p_value & 0x0000000000FF0000) >> 16);
- p_encoded_data[3] = (uint8_t) ((*p_value & 0x00000000FF000000) >> 24);
- p_encoded_data[4] = (uint8_t) ((*p_value & 0x000000FF00000000) >> 32);
- return 5;
- }
- static __INLINE uint8_t bds_sfloat_encode(const sfloat_t * p_value, uint8_t * p_encoded_data)
- {
- uint16_t encoded_val;
- encoded_val = ((p_value->exponent << 12) & 0xF000) |
- ((p_value->mantissa << 0) & 0x0FFF);
- return(bds_uint16_encode(&encoded_val, p_encoded_data));
- }
- static __INLINE uint8_t bds_uint8_array_encode(const uint8_array_t * p_value,
- uint8_t * p_encoded_data)
- {
- memcpy(p_encoded_data, p_value->p_data, p_value->size);
- return p_value->size;
- }
- static __INLINE uint8_t bds_ble_srv_utf8_str_encode(const ble_srv_utf8_str_t * p_value,
- uint8_t * p_encoded_data)
- {
- memcpy(p_encoded_data, p_value->p_str, p_value->length);
- return p_value->length;
- }
- static __INLINE uint8_t bds_regcertdatalist_encode(const regcertdatalist_t * p_value,
- uint8_t * p_encoded_data)
- {
- memcpy(p_encoded_data, p_value->p_list, p_value->list_len);
- return p_value->list_len;
- }
- static __INLINE uint8_t bds_ble_date_time_encode(const ble_date_time_t * p_date_time,
- uint8_t * p_encoded_data)
- {
- uint8_t len = bds_uint16_encode(&p_date_time->year, &p_encoded_data[0]);
- p_encoded_data[len++] = p_date_time->month;
- p_encoded_data[len++] = p_date_time->day;
- p_encoded_data[len++] = p_date_time->hours;
- p_encoded_data[len++] = p_date_time->minutes;
- p_encoded_data[len++] = p_date_time->seconds;
- return len;
- }
- static __INLINE uint8_t bds_uint16_decode(const uint8_t len,
- const uint8_t * p_encoded_data,
- uint16_t * p_decoded_val)
- {
- UNUSED_VARIABLE(len);
- *p_decoded_val = (((uint16_t)((uint8_t *)p_encoded_data)[0])) |
- (((uint16_t)((uint8_t *)p_encoded_data)[1]) << 8 );
- return (sizeof(uint16_t));
- }
- static __INLINE uint8_t bds_int16_decode(const uint8_t len,
- const uint8_t * p_encoded_data,
- int16_t * p_decoded_val)
- {
- UNUSED_VARIABLE(len);
- uint16_t tmp = 0;
- uint8_t retval = bds_uint16_decode(len, p_encoded_data, &tmp);
- *p_decoded_val = (int16_t)tmp;
- return retval;
- }
- static __INLINE uint8_t bds_uint24_decode(const uint8_t len,
- const uint8_t * p_encoded_data,
- uint32_t * p_decoded_val)
- {
- UNUSED_VARIABLE(len);
- *p_decoded_val = (((uint32_t)((uint8_t *)p_encoded_data)[0]) << 0) |
- (((uint32_t)((uint8_t *)p_encoded_data)[1]) << 8) |
- (((uint32_t)((uint8_t *)p_encoded_data)[2]) << 16);
- return (3);
- }
- static __INLINE uint8_t bds_uint32_decode(const uint8_t len,
- const uint8_t * p_encoded_data,
- uint32_t * p_decoded_val)
- {
- UNUSED_VARIABLE(len);
- *p_decoded_val = (((uint32_t)((uint8_t *)p_encoded_data)[0]) << 0) |
- (((uint32_t)((uint8_t *)p_encoded_data)[1]) << 8) |
- (((uint32_t)((uint8_t *)p_encoded_data)[2]) << 16) |
- (((uint32_t)((uint8_t *)p_encoded_data)[3]) << 24 );
- return (sizeof(uint32_t));
- }
- static __INLINE uint8_t bds_uint40_decode(const uint8_t len,
- const uint8_t * p_encoded_data,
- uint64_t * p_decoded_val)
- {
- UNUSED_VARIABLE(len);
- *p_decoded_val = (((uint64_t)((uint8_t *)p_encoded_data)[0]) << 0) |
- (((uint64_t)((uint8_t *)p_encoded_data)[1]) << 8) |
- (((uint64_t)((uint8_t *)p_encoded_data)[2]) << 16) |
- (((uint64_t)((uint8_t *)p_encoded_data)[3]) << 24 )|
- (((uint64_t)((uint8_t *)p_encoded_data)[4]) << 32 );
- return (40);
- }
- static __INLINE uint8_t bds_sfloat_decode(const uint8_t len,
- const uint8_t * p_encoded_data,
- sfloat_t * p_decoded_val)
- {
- p_decoded_val->exponent = 0;
- bds_uint16_decode(len, p_encoded_data, (uint16_t*)&p_decoded_val->mantissa);
- p_decoded_val->exponent = (uint8_t)((p_decoded_val->mantissa & 0xF000) >> 12);
- p_decoded_val->mantissa &= 0x0FFF;
- return len;
- }
- static __INLINE uint8_t bds_uint8_array_decode(const uint8_t len,
- const uint8_t * p_encoded_data,
- uint8_array_t * p_decoded_val)
- {
- memcpy(p_decoded_val->p_data, p_encoded_data, len);
- p_decoded_val->size = len;
- return p_decoded_val->size;
- }
- static __INLINE uint8_t bds_ble_srv_utf8_str_decode(const uint8_t len,
- const uint8_t * p_encoded_data,
- ble_srv_utf8_str_t * p_decoded_val)
- {
- p_decoded_val->p_str = (uint8_t*)p_encoded_data;
- p_decoded_val->length = len;
- return p_decoded_val->length;
- }
- static __INLINE uint8_t bds_regcertdatalist_decode(const uint8_t len,
- const uint8_t * p_encoded_data,
- regcertdatalist_t * p_decoded_val)
- {
- memcpy(p_decoded_val->p_list, p_encoded_data, len);
- p_decoded_val->list_len = len;
- return p_decoded_val->list_len;
- }
- static __INLINE uint8_t bds_ble_date_time_decode(const uint8_t len,
- const uint8_t * p_encoded_data,
- ble_date_time_t * p_date_time)
- {
- UNUSED_VARIABLE(len);
- uint8_t pos = bds_uint16_decode(len, &p_encoded_data[0], &p_date_time->year);
- p_date_time->month = p_encoded_data[pos++];
- p_date_time->day = p_encoded_data[pos++];
- p_date_time->hours = p_encoded_data[pos++];
- p_date_time->minutes = p_encoded_data[pos++];
- p_date_time->seconds = p_encoded_data[pos++];
- return pos;
- }
- #ifdef __cplusplus
- }
- #endif
- #endif
|