light_model.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242
  1. /*
  2. * Licensed to the Apache Software Foundation (ASF) under one
  3. * or more contributor license agreements. See the NOTICE file
  4. * distributed with this work for additional information
  5. * regarding copyright ownership. The ASF licenses this file
  6. * to you under the Apache License, Version 2.0 (the
  7. * "License"); you may not use this file except in compliance
  8. * with the License. You may obtain a copy of the License at
  9. *
  10. * http://www.apache.org/licenses/LICENSE-2.0
  11. *
  12. * Unless required by applicable law or agreed to in writing,
  13. * software distributed under the License is distributed on an
  14. * "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY
  15. * KIND, either express or implied. See the License for the
  16. * specific language governing permissions and limitations
  17. * under the License.
  18. */
  19. #include "syscfg/syscfg.h"
  20. #if MYNEWT_VAL(BLE_MESH_SHELL_MODELS)
  21. #include "mesh/mesh.h"
  22. #include "bsp.h"
  23. #include "pwm/pwm.h"
  24. #include "light_model.h"
  25. #include "ws2812.h"
  26. #if (!MYNEWT_VAL(USE_NEOPIXEL))
  27. #if MYNEWT_VAL(PWM_0)
  28. struct pwm_dev *pwm0;
  29. #endif
  30. #if MYNEWT_VAL(PWM_1)
  31. struct pwm_dev *pwm1;
  32. #endif
  33. #if MYNEWT_VAL(PWM_2)
  34. struct pwm_dev *pwm2;
  35. #endif
  36. #if MYNEWT_VAL(PWM_3)
  37. struct pwm_dev *pwm3;
  38. #endif
  39. static uint16_t top_val;
  40. #endif
  41. #if (MYNEWT_VAL(USE_NEOPIXEL))
  42. static uint32_t neopixel[WS2812_NUM_LED];
  43. #endif
  44. static u8_t gen_onoff_state;
  45. static s16_t gen_level_state;
  46. static void light_set_lightness(u8_t percentage)
  47. {
  48. #if (!MYNEWT_VAL(USE_NEOPIXEL))
  49. int rc;
  50. uint16_t pwm_val = (uint16_t) (percentage * top_val / 100);
  51. #if MYNEWT_VAL(PWM_0)
  52. rc = pwm_set_duty_cycle(pwm0, 0, pwm_val);
  53. assert(rc == 0);
  54. #endif
  55. #if MYNEWT_VAL(PWM_1)
  56. rc = pwm_set_duty_cycle(pwm1, 0, pwm_val);
  57. assert(rc == 0);
  58. #endif
  59. #if MYNEWT_VAL(PWM_2)
  60. rc = pwm_set_duty_cycle(pwm2, 0, pwm_val);
  61. assert(rc == 0);
  62. #endif
  63. #if MYNEWT_VAL(PWM_3)
  64. rc = pwm_set_duty_cycle(pwm3, 0, pwm_val);
  65. assert(rc == 0);
  66. #endif
  67. #else
  68. int i;
  69. u32_t lightness;
  70. u8_t max_lightness = 0x1f;
  71. lightness = (u8_t) (percentage * max_lightness / 100);
  72. for (i = 0; i < WS2812_NUM_LED; i++) {
  73. neopixel[i] = (lightness | lightness << 8 | lightness << 16);
  74. }
  75. ws2812_write(neopixel);
  76. #endif
  77. }
  78. static void update_light_state(void)
  79. {
  80. u16_t level = (u16_t)gen_level_state;
  81. int percent = 100 * level / 0xffff;
  82. if (gen_onoff_state == 0) {
  83. percent = 0;
  84. }
  85. light_set_lightness((uint8_t) percent);
  86. }
  87. int light_model_gen_onoff_get(struct bt_mesh_model *model, u8_t *state)
  88. {
  89. *state = gen_onoff_state;
  90. return 0;
  91. }
  92. int light_model_gen_onoff_set(struct bt_mesh_model *model, u8_t state)
  93. {
  94. gen_onoff_state = state;
  95. update_light_state();
  96. return 0;
  97. }
  98. int light_model_gen_level_get(struct bt_mesh_model *model, s16_t *level)
  99. {
  100. *level = gen_level_state;
  101. return 0;
  102. }
  103. int light_model_gen_level_set(struct bt_mesh_model *model, s16_t level)
  104. {
  105. gen_level_state = level;
  106. if ((u16_t)gen_level_state > 0x0000) {
  107. gen_onoff_state = 1;
  108. }
  109. if ((u16_t)gen_level_state == 0x0000) {
  110. gen_onoff_state = 0;
  111. }
  112. update_light_state();
  113. return 0;
  114. }
  115. int light_model_light_lightness_get(struct bt_mesh_model *model, s16_t *lightness)
  116. {
  117. return light_model_gen_level_get(model, lightness);
  118. }
  119. int light_model_light_lightness_set(struct bt_mesh_model *model, s16_t lightness)
  120. {
  121. return light_model_gen_level_set(model, lightness);
  122. }
  123. #if (!MYNEWT_VAL(USE_NEOPIXEL))
  124. struct pwm_dev_cfg dev_conf = {
  125. .n_cycles = 0,
  126. .int_prio = 3,
  127. };
  128. #if MYNEWT_VAL(PWM_0)
  129. static struct pwm_chan_cfg led1_conf = {
  130. .pin = LED_1,
  131. .inverted = true,
  132. };
  133. #endif
  134. #if MYNEWT_VAL(PWM_1)
  135. static struct pwm_chan_cfg led2_conf = {
  136. .pin = LED_2,
  137. .inverted = true,
  138. };
  139. #endif
  140. #if MYNEWT_VAL(PWM_2)
  141. static struct pwm_chan_cfg led3_conf = {
  142. .pin = LED_3,
  143. .inverted = true,
  144. };
  145. #endif
  146. #endif
  147. #if MYNEWT_VAL(PWM_3)
  148. static struct pwm_chan_cfg led4_conf = {
  149. .pin = LED_4,
  150. .inverted = true,
  151. };
  152. #endif
  153. #if (!MYNEWT_VAL(USE_NEOPIXEL))
  154. void init_pwm_dev(struct pwm_dev **pwm, char *dev_name, struct pwm_chan_cfg *chan_cfg)
  155. {
  156. int rc = 0;
  157. *pwm = (struct pwm_dev *) os_dev_open(dev_name, 0, NULL);
  158. assert(pwm);
  159. rc = pwm_configure_device(*pwm, &dev_conf);
  160. assert(rc == 0);
  161. rc = pwm_configure_channel(*pwm, 0, chan_cfg);
  162. assert(rc == 0);
  163. rc = pwm_enable(*pwm);
  164. assert(rc == 0);
  165. }
  166. int pwm_init(void)
  167. {
  168. #if MYNEWT_VAL(PWM_0)
  169. init_pwm_dev(&pwm0, "pwm0", &led1_conf);
  170. #endif
  171. #if MYNEWT_VAL(PWM_1)
  172. init_pwm_dev(&pwm1, "pwm1", &led2_conf);
  173. #endif
  174. #if MYNEWT_VAL(PWM_2)
  175. init_pwm_dev(&pwm2, "pwm2", &led3_conf);
  176. #endif
  177. #if MYNEWT_VAL(PWM_3)
  178. init_pwm_dev(&pwm3, "pwm3", &led4_conf);
  179. #endif
  180. if (!pwm0) {
  181. return 0;
  182. }
  183. top_val = (uint16_t) pwm_get_top_value(pwm0);
  184. update_light_state();
  185. return 0;
  186. }
  187. #endif
  188. #endif
  189. int light_model_init(void)
  190. {
  191. #if MYNEWT_VAL(BLE_MESH_SHELL_MODELS)
  192. int rc;
  193. #if (!MYNEWT_VAL(USE_NEOPIXEL))
  194. rc = pwm_init();
  195. assert(rc == 0);
  196. #else
  197. rc = ws2812_init();
  198. assert(rc == 0);
  199. update_light_state();
  200. #endif
  201. return rc;
  202. #else
  203. return 0;
  204. #endif
  205. }