state_binding.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336
  1. /* Bluetooth: Mesh Generic OnOff, Generic Level, Lighting & Vendor Models
  2. *
  3. * SPDX-FileCopyrightText: 2018 Vikrant More
  4. * SPDX-FileContributor: 2018-2021 Espressif Systems (Shanghai) CO LTD
  5. *
  6. * SPDX-License-Identifier: Apache-2.0
  7. */
  8. #include <errno.h>
  9. #include "mesh/config.h"
  10. #include "mesh/common.h"
  11. #include "mesh/model_common.h"
  12. #include "mesh/model_opcode.h"
  13. #include "mesh/state_binding.h"
  14. #include "mesh/state_transition.h"
  15. #if CONFIG_BLE_MESH_SERVER_MODEL
  16. uint16_t bt_mesh_convert_lightness_actual_to_linear(uint16_t actual)
  17. {
  18. float tmp = ((float) actual / UINT16_MAX);
  19. return bt_mesh_ceil(UINT16_MAX * tmp * tmp);
  20. }
  21. uint16_t bt_mesh_convert_lightness_linear_to_actual(uint16_t linear)
  22. {
  23. return (uint16_t) (UINT16_MAX * bt_mesh_sqrt(((float) linear / UINT16_MAX)));
  24. }
  25. int16_t bt_mesh_convert_temperature_to_gen_level(uint16_t temp, uint16_t min, uint16_t max)
  26. {
  27. float tmp = (temp - min) * UINT16_MAX / (max - min);
  28. return (int16_t) (tmp + INT16_MIN);
  29. }
  30. uint16_t bt_mesh_covert_gen_level_to_temperature(int16_t level, uint16_t min, uint16_t max)
  31. {
  32. float diff = (float) (max - min) / UINT16_MAX;
  33. uint16_t tmp = (uint16_t) ((level - INT16_MIN) * diff);
  34. return (uint16_t) (min + tmp);
  35. }
  36. int16_t bt_mesh_convert_hue_to_level(uint16_t hue)
  37. {
  38. return (int16_t) (hue + INT16_MIN);
  39. }
  40. uint16_t bt_mesh_convert_level_to_hue(int16_t level)
  41. {
  42. return (uint16_t) (level - INT16_MIN);
  43. }
  44. int16_t bt_mesh_convert_saturation_to_level(uint16_t saturation)
  45. {
  46. return (int16_t) (saturation + INT16_MIN);
  47. }
  48. uint16_t bt_mesh_convert_level_to_saturation(int16_t level)
  49. {
  50. return (uint16_t) (level - INT16_MIN);
  51. }
  52. int bt_mesh_update_binding_state(struct bt_mesh_model *model,
  53. bt_mesh_server_state_type_t type,
  54. bt_mesh_server_state_value_t *value)
  55. {
  56. if (model == NULL || model->user_data == NULL ||
  57. value == NULL || type > BIND_STATE_MAX) {
  58. BT_ERR("%s, Invalid parameter", __func__);
  59. return -EINVAL;
  60. }
  61. switch (type) {
  62. #if CONFIG_BLE_MESH_GENERIC_SERVER
  63. case GENERIC_ONOFF_STATE: {
  64. if (model->id != BLE_MESH_MODEL_ID_GEN_ONOFF_SRV) {
  65. BT_ERR("Invalid Generic OnOff Server, model id 0x%04x", model->id);
  66. return -EINVAL;
  67. }
  68. struct bt_mesh_gen_onoff_srv *srv = model->user_data;
  69. bt_mesh_server_stop_transition(&srv->transition);
  70. srv->state.onoff = value->gen_onoff.onoff;
  71. gen_onoff_publish(model);
  72. break;
  73. }
  74. case GENERIC_LEVEL_STATE: {
  75. if (model->id != BLE_MESH_MODEL_ID_GEN_LEVEL_SRV) {
  76. BT_ERR("Invalid Generic Level Server, model id 0x%04x", model->id);
  77. return -EINVAL;
  78. }
  79. struct bt_mesh_gen_level_srv *srv = model->user_data;
  80. bt_mesh_server_stop_transition(&srv->transition);
  81. srv->state.level = value->gen_level.level;
  82. gen_level_publish(model);
  83. break;
  84. }
  85. case GENERIC_ONPOWERUP_STATE: {
  86. if (model->id != BLE_MESH_MODEL_ID_GEN_POWER_ONOFF_SRV) {
  87. BT_ERR("Invalid Generic Power OnOff Server, model id 0x%04x", model->id);
  88. return -EINVAL;
  89. }
  90. struct bt_mesh_gen_power_onoff_srv *srv = model->user_data;
  91. if (srv->state == NULL) {
  92. BT_ERR("Invalid Generic Power OnOff Server state");
  93. return -EINVAL;
  94. }
  95. srv->state->onpowerup = value->gen_onpowerup.onpowerup;
  96. gen_onpowerup_publish(model);
  97. break;
  98. }
  99. case GENERIC_POWER_ACTUAL_STATE: {
  100. if (model->id != BLE_MESH_MODEL_ID_GEN_POWER_LEVEL_SRV) {
  101. BT_ERR("Invalid Generic Power Level Server, model id 0x%04x", model->id);
  102. return -EINVAL;
  103. }
  104. struct bt_mesh_gen_power_level_srv *srv = model->user_data;
  105. if (srv->state == NULL) {
  106. BT_ERR("Invalid Generic Power Level Server state");
  107. return -EINVAL;
  108. }
  109. bt_mesh_server_stop_transition(&srv->transition);
  110. srv->state->power_actual = value->gen_power_actual.power;
  111. /**
  112. * Whenever the Generic Power Actual state is changed to a non-zero value
  113. * as a result of a non-transactional message or a completed sequence of
  114. * transactional messages, the value of the Generic Power Last state shall
  115. * be set to the value of the Generic Power Actual state.
  116. */
  117. if (srv->state->power_actual) {
  118. srv->state->power_last = srv->state->power_actual;
  119. }
  120. gen_power_level_publish(model, BLE_MESH_MODEL_OP_GEN_POWER_LEVEL_STATUS);
  121. break;
  122. }
  123. #endif /* CONFIG_BLE_MESH_GENERIC_SERVER */
  124. #if CONFIG_BLE_MESH_LIGHTING_SERVER
  125. case LIGHT_LIGHTNESS_ACTUAL_STATE: {
  126. if (model->id != BLE_MESH_MODEL_ID_LIGHT_LIGHTNESS_SRV) {
  127. BT_ERR("Invalid Light Lightness Server, model id 0x%04x", model->id);
  128. return -EINVAL;
  129. }
  130. struct bt_mesh_light_lightness_srv *srv = model->user_data;
  131. if (srv->state == NULL) {
  132. BT_ERR("Invalid Light Lightness Server state");
  133. return -EINVAL;
  134. }
  135. bt_mesh_server_stop_transition(&srv->actual_transition);
  136. srv->state->lightness_actual = value->light_lightness_actual.lightness;
  137. /**
  138. * Whenever the Light Lightness Actual state is changed with a non-transactional
  139. * message or a completed sequence of transactional messages to a non-zero value,
  140. * the value of the Light Lightness Last shall be set to the value of the Light
  141. * Lightness Actual.
  142. */
  143. if (srv->state->lightness_actual) {
  144. srv->state->lightness_last = srv->state->lightness_actual;
  145. }
  146. light_lightness_publish(model, BLE_MESH_MODEL_OP_LIGHT_LIGHTNESS_STATUS);
  147. break;
  148. }
  149. case LIGHT_LIGHTNESS_LINEAR_STATE: {
  150. if (model->id != BLE_MESH_MODEL_ID_LIGHT_LIGHTNESS_SRV) {
  151. BT_ERR("Invalid Light Lightness Server, model id 0x%04x", model->id);
  152. return -EINVAL;
  153. }
  154. struct bt_mesh_light_lightness_srv *srv = model->user_data;
  155. if (srv->state == NULL) {
  156. BT_ERR("Invalid Light Lightness Server state");
  157. return -EINVAL;
  158. }
  159. bt_mesh_server_stop_transition(&srv->linear_transition);
  160. srv->state->lightness_linear = value->light_lightness_linear.lightness;
  161. light_lightness_publish(model, BLE_MESH_MODEL_OP_LIGHT_LIGHTNESS_LINEAR_STATUS);
  162. break;
  163. }
  164. case LIGHT_CTL_LIGHTNESS_STATE: {
  165. if (model->id != BLE_MESH_MODEL_ID_LIGHT_CTL_SRV) {
  166. BT_ERR("Invalid Light CTL Server, model id 0x%04x", model->id);
  167. return -EINVAL;
  168. }
  169. struct bt_mesh_light_ctl_srv *srv = model->user_data;
  170. if (srv->state == NULL) {
  171. BT_ERR("Invalid Light CTL Server state");
  172. return -EINVAL;
  173. }
  174. bt_mesh_server_stop_transition(&srv->transition);
  175. srv->state->lightness = value->light_ctl_lightness.lightness;
  176. light_ctl_publish(model, BLE_MESH_MODEL_OP_LIGHT_CTL_STATUS);
  177. break;
  178. }
  179. case LIGHT_CTL_TEMP_DELTA_UV_STATE: {
  180. if (model->id != BLE_MESH_MODEL_ID_LIGHT_CTL_TEMP_SRV) {
  181. BT_ERR("Invalid Light CTL Temperature Server, model id 0x%04x", model->id);
  182. return -EINVAL;
  183. }
  184. struct bt_mesh_light_ctl_temp_srv *srv = model->user_data;
  185. if (srv->state == NULL) {
  186. BT_ERR("Invalid Light CTL Temperature Server state");
  187. return -EINVAL;
  188. }
  189. bt_mesh_server_stop_transition(&srv->transition);
  190. srv->state->temperature = value->light_ctl_temp_delta_uv.temperature;
  191. srv->state->delta_uv = value->light_ctl_temp_delta_uv.delta_uv;
  192. light_ctl_publish(model, BLE_MESH_MODEL_OP_LIGHT_CTL_TEMPERATURE_STATUS);
  193. break;
  194. }
  195. case LIGHT_HSL_STATE: {
  196. if (model->id != BLE_MESH_MODEL_ID_LIGHT_HSL_SRV) {
  197. BT_ERR("Invalid Light HSL Server, model id 0x%04x", model->id);
  198. return -EINVAL;
  199. }
  200. struct bt_mesh_light_hsl_srv *srv = model->user_data;
  201. if (srv->state == NULL) {
  202. BT_ERR("Invalid Light HSL Server state");
  203. return -EINVAL;
  204. }
  205. bt_mesh_server_stop_transition(&srv->transition);
  206. srv->state->lightness = value->light_hsl.lightness;
  207. srv->state->hue = value->light_hsl.hue;
  208. srv->state->saturation = value->light_hsl.saturation;
  209. light_hsl_publish(model, BLE_MESH_MODEL_OP_LIGHT_HSL_STATUS);
  210. break;
  211. }
  212. case LIGHT_HSL_LIGHTNESS_STATE: {
  213. if (model->id != BLE_MESH_MODEL_ID_LIGHT_HSL_SRV) {
  214. BT_ERR("Invalid Light HSL Server, model id 0x%04x", model->id);
  215. return -EINVAL;
  216. }
  217. struct bt_mesh_light_hsl_srv *srv = model->user_data;
  218. if (srv->state == NULL) {
  219. BT_ERR("Invalid Light HSL Server state");
  220. return -EINVAL;
  221. }
  222. bt_mesh_server_stop_transition(&srv->transition);
  223. srv->state->lightness = value->light_hsl_lightness.lightness;
  224. light_hsl_publish(model, BLE_MESH_MODEL_OP_LIGHT_HSL_STATUS);
  225. break;
  226. }
  227. case LIGHT_HSL_HUE_STATE: {
  228. if (model->id != BLE_MESH_MODEL_ID_LIGHT_HSL_HUE_SRV) {
  229. BT_ERR("Invalid Light HSL Hue Server, model id 0x%04x", model->id);
  230. return -EINVAL;
  231. }
  232. struct bt_mesh_light_hsl_hue_srv *srv = model->user_data;
  233. if (srv->state == NULL) {
  234. BT_ERR("Invalid Light HSL Hue Server state");
  235. return -EINVAL;
  236. }
  237. bt_mesh_server_stop_transition(&srv->transition);
  238. srv->state->hue = value->light_hsl_hue.hue;
  239. light_hsl_publish(model, BLE_MESH_MODEL_OP_LIGHT_HSL_HUE_STATUS);
  240. break;
  241. }
  242. case LIGHT_HSL_SATURATION_STATE: {
  243. if (model->id != BLE_MESH_MODEL_ID_LIGHT_HSL_SAT_SRV) {
  244. BT_ERR("Invalid Light HSL Saturation Server, model id 0x%04x", model->id);
  245. return -EINVAL;
  246. }
  247. struct bt_mesh_light_hsl_sat_srv *srv = model->user_data;
  248. if (srv->state == NULL) {
  249. BT_ERR("Invalid Light HSL Saturation Server state");
  250. return -EINVAL;
  251. }
  252. bt_mesh_server_stop_transition(&srv->transition);
  253. srv->state->saturation = value->light_hsl_saturation.saturation;
  254. light_hsl_publish(model, BLE_MESH_MODEL_OP_LIGHT_HSL_SATURATION_STATUS);
  255. break;
  256. }
  257. case LIGHT_XYL_LIGHTNESS_STATE: {
  258. if (model->id != BLE_MESH_MODEL_ID_LIGHT_XYL_SRV) {
  259. BT_ERR("Invalid Light xyL Server, model id 0x%04x", model->id);
  260. return -EINVAL;
  261. }
  262. struct bt_mesh_light_xyl_srv *srv = model->user_data;
  263. if (srv->state == NULL) {
  264. BT_ERR("Invalid Light xyL Server state");
  265. return -EINVAL;
  266. }
  267. bt_mesh_server_stop_transition(&srv->transition);
  268. srv->state->lightness = value->light_xyl_lightness.lightness;
  269. light_xyl_publish(model, BLE_MESH_MODEL_OP_LIGHT_XYL_STATUS);
  270. break;
  271. }
  272. case LIGHT_LC_LIGHT_ONOFF_STATE: {
  273. if (model->id != BLE_MESH_MODEL_ID_LIGHT_LC_SRV) {
  274. BT_ERR("Invalid Light LC Server, model id 0x%04x", model->id);
  275. return -EINVAL;
  276. }
  277. struct bt_mesh_light_lc_srv *srv = model->user_data;
  278. if (srv->lc == NULL) {
  279. BT_ERR("Invalid Light LC Server state");
  280. return -EINVAL;
  281. }
  282. bt_mesh_server_stop_transition(&srv->transition);
  283. srv->lc->state.light_onoff = value->light_lc_light_onoff.onoff;
  284. light_lc_publish(model, BLE_MESH_MODEL_OP_LIGHT_LC_LIGHT_ONOFF_STATUS);
  285. break;
  286. }
  287. #endif /* CONFIG_BLE_MESH_LIGHTING_SERVER */
  288. default:
  289. BT_WARN("Unknown binding state type 0x%02x", type);
  290. return -EINVAL;
  291. }
  292. return 0;
  293. }
  294. #endif /* CONFIG_BLE_MESH_SERVER_MODEL */