ant_struct_serialization.c 6.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159
  1. /**
  2. * Copyright (c) 2017 - 2020, Nordic Semiconductor ASA
  3. *
  4. * All rights reserved.
  5. *
  6. * Redistribution and use in source and binary forms, with or without modification,
  7. * are permitted provided that the following conditions are met:
  8. *
  9. * 1. Redistributions of source code must retain the above copyright notice, this
  10. * list of conditions and the following disclaimer.
  11. *
  12. * 2. Redistributions in binary form, except as embedded into a Nordic
  13. * Semiconductor ASA integrated circuit in a product or a software update for
  14. * such product, must reproduce the above copyright notice, this list of
  15. * conditions and the following disclaimer in the documentation and/or other
  16. * materials provided with the distribution.
  17. *
  18. * 3. Neither the name of Nordic Semiconductor ASA nor the names of its
  19. * contributors may be used to endorse or promote products derived from this
  20. * software without specific prior written permission.
  21. *
  22. * 4. This software, with or without modification, must only be used with a
  23. * Nordic Semiconductor ASA integrated circuit.
  24. *
  25. * 5. Any software provided in binary form under this license must not be reverse
  26. * engineered, decompiled, modified and/or disassembled.
  27. *
  28. * THIS SOFTWARE IS PROVIDED BY NORDIC SEMICONDUCTOR ASA "AS IS" AND ANY EXPRESS
  29. * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  30. * OF MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
  31. * DISCLAIMED. IN NO EVENT SHALL NORDIC SEMICONDUCTOR ASA OR CONTRIBUTORS BE
  32. * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  33. * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
  34. * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  35. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  36. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
  37. * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  38. *
  39. */
  40. #include "ant_interface.h"
  41. #include "ant_struct_serialization.h"
  42. #include "nrf_sdh_ant.h"
  43. #include "ble_serialization.h"
  44. #include "app_util.h"
  45. #include "cond_field_serialization.h"
  46. #include <string.h>
  47. uint32_t ANT_ENABLE_enc(void const * const p_void_enable_params,
  48. uint8_t * const p_buf,
  49. uint32_t buf_len,
  50. uint32_t * const p_index)
  51. {
  52. SER_ASSERT_NOT_NULL(p_buf);
  53. SER_ASSERT_NOT_NULL(p_index);
  54. SER_ASSERT_NOT_NULL(p_void_enable_params);
  55. ANT_ENABLE * p_enable_params = (ANT_ENABLE *)p_void_enable_params;
  56. uint32_t err_code = NRF_SUCCESS;
  57. err_code = uint8_t_enc(&p_enable_params->ucTotalNumberOfChannels, p_buf, buf_len, p_index);
  58. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  59. err_code = uint8_t_enc(&p_enable_params->ucNumberOfEncryptedChannels, p_buf, buf_len, p_index);
  60. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  61. err_code = uint16_t_enc(&p_enable_params->usNumberOfEvents, p_buf, buf_len, p_index);
  62. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  63. err_code = uint32_t_enc(&p_enable_params->pucMemoryBlockStartLocation, p_buf, buf_len, p_index);
  64. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  65. err_code = uint16_t_enc(&p_enable_params->usMemoryBlockByteSize, p_buf, buf_len, p_index);
  66. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  67. return err_code;
  68. }
  69. uint32_t ANT_ENABLE_dec(uint8_t const * const p_buf,
  70. uint32_t buf_len,
  71. uint32_t * const p_index,
  72. void * const p_void_enable_params)
  73. {
  74. SER_ASSERT_NOT_NULL(p_buf);
  75. SER_ASSERT_NOT_NULL(p_index);
  76. SER_ASSERT_NOT_NULL(p_void_enable_params);
  77. ANT_ENABLE * p_enable_params = (ANT_ENABLE *)p_void_enable_params;
  78. uint32_t err_code = NRF_SUCCESS;
  79. err_code = uint8_t_dec(p_buf, buf_len, p_index, &p_enable_params->ucTotalNumberOfChannels);
  80. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  81. err_code = uint8_t_dec(p_buf, buf_len, p_index, &p_enable_params->ucNumberOfEncryptedChannels);
  82. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  83. err_code = uint16_t_dec(p_buf, buf_len, p_index, &p_enable_params->usNumberOfEvents);
  84. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  85. err_code = uint32_t_dec(p_buf, buf_len, p_index, &p_enable_params->pucMemoryBlockStartLocation);
  86. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  87. err_code = uint16_t_dec(p_buf, buf_len, p_index, &p_enable_params->usMemoryBlockByteSize);
  88. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  89. return err_code;
  90. }
  91. uint32_t ant_evt_t_enc(void const * const p_void_ant_evt,
  92. uint8_t * const p_buf,
  93. uint32_t buf_len,
  94. uint32_t * const p_index)
  95. {
  96. SER_ASSERT_NOT_NULL(p_buf);
  97. SER_ASSERT_NOT_NULL(p_index);
  98. SER_ASSERT_NOT_NULL(p_void_ant_evt);
  99. ant_evt_t * p_ant_evt = (ant_evt_t *)p_void_ant_evt;
  100. uint32_t err_code = NRF_SUCCESS;
  101. memcpy(&p_buf[*p_index], p_ant_evt->message.aucMessage, MESG_BUFFER_SIZE); // Size + sizeof(size) & sizeof(msg id)
  102. *p_index += MESG_BUFFER_SIZE;
  103. err_code = uint8_t_enc(&p_ant_evt->event, p_buf, buf_len, p_index);
  104. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  105. err_code = uint8_t_enc(&p_ant_evt->channel, p_buf, buf_len, p_index);
  106. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  107. return(err_code);
  108. }
  109. uint32_t ant_evt_t_dec(uint8_t const * const p_buf,
  110. uint32_t buf_len,
  111. uint32_t * const p_index,
  112. void * const p_void_ant_evt)
  113. {
  114. SER_ASSERT_NOT_NULL(p_buf);
  115. SER_ASSERT_NOT_NULL(p_index);
  116. SER_ASSERT_NOT_NULL(p_void_ant_evt);
  117. ant_evt_t * p_ant_evt = (ant_evt_t *)p_void_ant_evt;
  118. uint32_t err_code = NRF_SUCCESS;
  119. memcpy(p_ant_evt->message.aucMessage, &p_buf[*p_index], MESG_BUFFER_SIZE); // Size + sizeof(size) & sizeof(msg id)
  120. *p_index += MESG_BUFFER_SIZE;
  121. err_code = uint8_t_dec(p_buf, buf_len, p_index, &p_ant_evt->event);
  122. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  123. err_code = uint8_t_dec(p_buf, buf_len, p_index, &p_ant_evt->channel);
  124. SER_ASSERT(err_code == NRF_SUCCESS, err_code);
  125. return err_code;
  126. }