beep.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393
  1. /*
  2. * Copyright (c) 2006-2020, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2020-05-23 Administrator the first version
  9. */
  10. #include <rtdevice.h> //使用 RT-Thread 的设备需要包含此头文件
  11. #include <beep.h>
  12. #include <control.h>
  13. #include "hmi.h"
  14. #define HWTIMER_DEV_NAME "timer2" /* 定时器名称 */
  15. /* device_status 已收敛为全工程唯一定义(在 main.c), 此处不再重复定义, 见 control.h 的 extern 声明 */
  16. struct rt_device_pwm *pwm_device = RT_NULL; //定义 pwm 设备指针
  17. struct rt_device_pwm *pwm_tim8 = RT_NULL; //定义 pwm 设备指针
  18. /* 定时器设备句柄(文件作用域, 供 beep_timer_release() 在线程上下文收尾) */
  19. rt_device_t hw_dev = RT_NULL;
  20. /* ★ ISR 里只允许置标志 + 纯 HAL 操作, 不允许任何可能阻塞的 API。
  21. g_beep_timer_fired: hwtimer one-shot 已到期, 由线程上下文的 beep_timer_release() 收尾。 */
  22. static volatile uint8_t g_beep_timer_fired = 0;
  23. /* 定时器超时回调函数(硬件定时器中断上下文) */
  24. static rt_err_t timeout_cb(rt_device_t dev, rt_size_t size)
  25. {
  26. /* ★ 原实现在 ISR 里做了三件不该做的事:
  27. ① rt_kprintf -> 走 console 设备 rt_device_write, 发送未完成时会在完成量上等待;
  28. ② rt_device_close -> 内部有 RT_ASSERT 且会调 dev->close(), 属线程上下文 API;
  29. 这两者在中断里调用会死锁在 ISR 内, 整机停死后 5s 看门狗复位,
  30. 现象是"蜂鸣器响/电机走到限位时随机死机"。
  31. 现在只置标志 + 关 PWM(rt_pwm_disable 走 HAL, 不取任何 IPC 锁)。 */
  32. g_beep_timer_fired = 1;
  33. if (pwm_device != RT_NULL)
  34. {
  35. rt_pwm_disable(pwm_device, BEEP_PWM_CH);
  36. }
  37. return 0;
  38. }
  39. /* 线程上下文: 关掉上一次 one-shot 到期后遗留的 hwtimer 设备句柄。
  40. 不能在 timeout_cb 里 close(见上), 放在下一次 init_tim2() 开头收尾。 */
  41. static void beep_timer_release(void)
  42. {
  43. if (g_beep_timer_fired && hw_dev != RT_NULL)
  44. {
  45. rt_device_close(hw_dev);
  46. hw_dev = RT_NULL;
  47. }
  48. g_beep_timer_fired = 0;
  49. }
  50. static int hwtimer_sample(int argc, char *argv[])
  51. {
  52. rt_err_t ret = RT_EOK;
  53. rt_hwtimerval_t timeout_s; /* 定时器超时值 */
  54. rt_device_t hw_dev = RT_NULL; /* 定时器设备句柄 */
  55. rt_hwtimer_mode_t mode; /* 定时器模式 */
  56. rt_uint32_t freq = 10000; /* 计数频率 */
  57. /* 查找定时器设备 */
  58. hw_dev = rt_device_find(HWTIMER_DEV_NAME);
  59. if (hw_dev == RT_NULL)
  60. {
  61. rt_kprintf("hwtimer sample run failed! can't find %s device!\n", HWTIMER_DEV_NAME);
  62. return RT_ERROR;
  63. }
  64. /* 以读写方式打开设备 */
  65. ret = rt_device_open(hw_dev, RT_DEVICE_OFLAG_RDWR);
  66. if (ret != RT_EOK)
  67. {
  68. rt_kprintf("open %s device failed!\n", HWTIMER_DEV_NAME);
  69. return ret;
  70. }
  71. /* 设置超时回调函数 */
  72. rt_device_set_rx_indicate(hw_dev, timeout_cb);
  73. /* 设置计数频率(若未设置该项,默认为1Mhz 或 支持的最小计数频率) */
  74. rt_device_control(hw_dev, HWTIMER_CTRL_FREQ_SET, &freq);
  75. /* 设置模式为周期性定时器(若未设置,默认是HWTIMER_MODE_ONESHOT)*/
  76. mode = HWTIMER_MODE_PERIOD; //HWTIMER_MODE_ONESHOT;
  77. ret = rt_device_control(hw_dev, HWTIMER_CTRL_MODE_SET, &mode);
  78. if (ret != RT_EOK)
  79. {
  80. rt_kprintf("set mode failed! ret is :%d\n", ret);
  81. return ret;
  82. }
  83. /* 设置定时器超时值为5s并启动定时器 */
  84. timeout_s.sec = 10; /* 秒 */
  85. timeout_s.usec = 0; /* 微秒 */
  86. if (rt_device_write(hw_dev, 0, &timeout_s, sizeof(timeout_s)) != sizeof(timeout_s))
  87. {
  88. rt_kprintf("set timeout value failed\n");
  89. return RT_ERROR;
  90. }
  91. //beep_init();
  92. hwtimer2_pwm3_output(0,20000,1,1);
  93. return ret;
  94. }
  95. /*初始化蜂鸣器*/
  96. int beep_init(void)
  97. {
  98. /*查找PWM设备*/
  99. pwm_device = (struct rt_device_pwm *)rt_device_find(BEEP_PWM_DEVICE);
  100. if(pwm_device==RT_NULL)
  101. {
  102. rt_kprintf("pwm device %s not found!\n", BEEP_PWM_DEVICE);
  103. return -RT_ERROR;
  104. }
  105. return 0;
  106. }
  107. static int init_pwm3(void)
  108. {
  109. /*查找PWM设备*/
  110. pwm_device = (struct rt_device_pwm *)rt_device_find(BEEP_PWM_DEVICE);
  111. if(pwm_device==RT_NULL)
  112. {
  113. rt_kprintf("pwm device %s not found!\n", BEEP_PWM_DEVICE);
  114. return -RT_ERROR;
  115. }
  116. return 0;
  117. }
  118. static int init_tim2(void)
  119. {
  120. rt_err_t ret = RT_EOK;
  121. rt_hwtimerval_t timeout_s; /* 定时器超时值 */
  122. rt_hwtimer_mode_t mode; /* 定时器模式 */
  123. rt_uint32_t freq = 10000; /* 计数频率 */
  124. /* ★ 原来这里又声明了一个同名的局部 hw_dev, 把文件作用域的 hw_dev 整个屏蔽掉,
  125. 函数一返回句柄就丢了, beep_timer_release() 无从收尾。改用全局那份。 */
  126. beep_timer_release();
  127. /* 查找定时器设备 */
  128. hw_dev = rt_device_find(HWTIMER_DEV_NAME);
  129. if (hw_dev == RT_NULL)
  130. {
  131. rt_kprintf("hwtimer sample run failed! can't find %s device!\n", HWTIMER_DEV_NAME);
  132. return RT_ERROR;
  133. }
  134. /* 以读写方式打开设备 */
  135. ret = rt_device_open(hw_dev, RT_DEVICE_OFLAG_RDWR);
  136. if (ret != RT_EOK)
  137. {
  138. rt_kprintf("open %s device failed!\n", HWTIMER_DEV_NAME);
  139. return ret;
  140. }
  141. /* 设置超时回调函数 */
  142. rt_device_set_rx_indicate(hw_dev, timeout_cb);
  143. /* 设置计数频率(若未设置该项,默认为1Mhz 或 支持的最小计数频率) */
  144. rt_device_control(hw_dev, HWTIMER_CTRL_FREQ_SET, &freq);
  145. /* 设置模式为周期性定时器(若未设置,默认是HWTIMER_MODE_ONESHOT)*/
  146. mode = HWTIMER_MODE_ONESHOT; //HWTIMER_MODE_ONESHOT;
  147. ret = rt_device_control(hw_dev, HWTIMER_CTRL_MODE_SET, &mode);
  148. if (ret != RT_EOK)
  149. {
  150. rt_kprintf("set mode failed! ret is :%d\n", ret);
  151. return ret;
  152. }
  153. /* 设置定时器超时值为5s并启动定时器 */
  154. timeout_s.sec = 0; /* 秒 */
  155. timeout_s.usec = 500000; /* 微秒 */ //100ms
  156. if (rt_device_write(hw_dev, 0, &timeout_s, sizeof(timeout_s)) != sizeof(timeout_s))
  157. {
  158. rt_kprintf("set timeout value failed\n");
  159. return RT_ERROR;
  160. }
  161. return 0;
  162. }
  163. int hwtimer2_pwm3_output(rt_uint32_t time,rt_uint32_t freq,uint8_t EN,uint8_t DIR)
  164. {
  165. ctr_Motor_Driver_Power(ON);
  166. rt_thread_delay(100);
  167. rt_pin_mode(Motor_EN, PIN_MODE_OUTPUT);
  168. rt_pin_mode(Motor_DIR, PIN_MODE_OUTPUT);
  169. rt_pin_write(Motor_EN, EN);
  170. rt_thread_delay(1);
  171. rt_pin_write(Motor_DIR, DIR);
  172. /* ★ init_pwm3() 失败时 pwm_device 为 NULL, 原代码不判空直接传给 rt_pwm_set/enable
  173. -> 解引用空 struct rt_device_pwm -> hard fault。 */
  174. if (init_pwm3() != 0 || pwm_device == RT_NULL)
  175. {
  176. rt_kprintf("hwtimer2_pwm3_output: pwm3 not available!\n");
  177. return -RT_ERROR;
  178. }
  179. rt_pwm_set(pwm_device, BEEP_PWM_CH, freq, freq/2);//channel,period,pulse
  180. if(init_tim2()==0)
  181. rt_pwm_enable(pwm_device, BEEP_PWM_CH); //使能蜂鸣器对应的 PWM 通道
  182. return 0;
  183. }
  184. /* 86 电机限位中断回调(GPIO 中断上下文)
  185. ★ 形参必须是 void *args: rt_pin_attach_irq 要求的类型是 void (*)(void *),
  186. 原来声明成 void(void), 属函数指针类型不匹配(未定义行为)。 */
  187. static void stop_motor_86(void *args)
  188. {
  189. (void)args;
  190. /* ★ 原来是 rt_kprintf + 无判空的 rt_pwm_disable。
  191. rt_kprintf 在中断里走 console 设备写, 可能阻塞 -> 死锁在 ISR。
  192. PWM 句柄为空时 rt_pwm_disable 会解引用空 struct -> hard fault。 */
  193. if (pwm_device != RT_NULL)
  194. {
  195. rt_pwm_disable(pwm_device, BEEP_PWM_CH);
  196. }
  197. }
  198. void pin_motor_86_bind(void)
  199. {
  200. rt_pin_mode(MOTOR_86, PIN_MODE_INPUT);
  201. /* 绑定中断,下降沿模式,回调函数名为 */
  202. rt_pin_attach_irq(MOTOR_86, PIN_IRQ_MODE_FALLING, stop_motor_86, RT_NULL);
  203. /* 使能中断 */
  204. rt_pin_irq_enable(MOTOR_86, PIN_IRQ_ENABLE);
  205. }
  206. void pin_motor_86_unbind(void)
  207. {
  208. rt_pin_detach_irq(MOTOR_86);
  209. }
  210. /*打开蜂鸣器*/
  211. int pwm_on(uint8_t pwn_ch,rt_uint32_t pwm_freq)
  212. {
  213. /* ★ PWM 句柄判空(与 beep_init 等价, 找不到设备时返回非 0) */
  214. if (pwm_device == RT_NULL && beep_init() != 0)
  215. return -RT_ERROR;
  216. rt_pwm_set(pwm_device, pwn_ch, pwm_freq, pwm_freq/2);
  217. rt_pwm_enable(pwm_device, pwn_ch); //使能蜂鸣器对应的 PWM 通道
  218. return 0;
  219. }
  220. /*关闭蜂鸣器*/
  221. int pwm_off(uint8_t pwn_ch,rt_uint32_t pwm_freq)
  222. {
  223. if (pwm_device == RT_NULL && beep_init() != 0)
  224. return -RT_ERROR;
  225. rt_pwm_set(pwm_device, pwn_ch, pwm_freq, 0);
  226. rt_pwm_disable(pwm_device, pwn_ch); //使能蜂鸣器对应的 PWM 通道
  227. return 0;
  228. }
  229. int pwm8_init(void)
  230. {
  231. pwm_tim8 = (struct rt_device_pwm *)rt_device_find("pwm8");
  232. if(pwm_tim8==RT_NULL)
  233. {
  234. rt_kprintf("pwm device pwm8 not found!\n");
  235. return -RT_ERROR;
  236. }
  237. return 0;
  238. }
  239. /*打开蜂鸣器*/
  240. int beep_on(void)
  241. {
  242. if (pwm_device == RT_NULL && beep_init() != 0)
  243. return -RT_ERROR;
  244. rt_pwm_enable(pwm_device, BEEP_PWM_CH); //使能蜂鸣器对应的 PWM 通道
  245. return 0;
  246. }
  247. /*关闭蜂鸣器*/
  248. int beep_off(void)
  249. {
  250. if (pwm_device == RT_NULL && beep_init() != 0)
  251. return -RT_ERROR;
  252. rt_pwm_disable(pwm_device, BEEP_PWM_CH); //失能蜂鸣器对应的 PWM 通道
  253. return 0;
  254. }
  255. /*在蜂鸣器设定函数里需要设定 蜂鸣器的频率和音量。PWM 设备设定的 API 是设定 周期 和 脉宽 的,
  256. * 因此我们需要转换一下,将频率装换成周期,将音量大小(占空比)转换成脉宽。这里的周期的单位是 ns,
  257. * 因此转换成的 秒 之后还要乘以 10^9 。由于无源蜂鸣器一般是低电平触发的,因此音量越大对应的脉宽就要越小。
  258. * 然后,将转换后的数据传入 rt_pwm_set 来设置 PWM 设备的参数。
  259. *
  260. */
  261. void beep_set(uint32_t freq, uint32_t volume)
  262. {
  263. rt_uint32_t period, pulse;
  264. /* ★ beep_init() 失败时 pwm_device 仍是 NULL, 原代码不判空继续用 -> hard fault */
  265. if (beep_init() != 0 || pwm_device == RT_NULL)
  266. return;
  267. /* 将频率转化为周期 周期单位:ns 频率单位:HZ */
  268. //period = 1000000000 / freq; //unit:ns 1/HZ*10^9 = ns
  269. period = freq; /* 周期为0.5ms,单位为纳秒500000ns-200k */
  270. /* 根据声音大小计算占空比 蜂鸣器低电平触发 */
  271. pulse = volume; //5000
  272. if(freq==0)
  273. {
  274. rt_pwm_disable(pwm_device, BEEP_PWM_CH);
  275. }else {
  276. /* 利用 PWM API 设定 周期和占空比 */
  277. rt_pwm_set(pwm_device, BEEP_PWM_CH, period, pulse);//channel,period,pulse
  278. rt_pwm_enable(pwm_device, BEEP_PWM_CH);
  279. }
  280. }
  281. void Beep_Tip(uint16_t volnum)
  282. {
  283. rt_pin_mode(Beep, PIN_MODE_OUTPUT);
  284. rt_pin_write(Beep, 1);
  285. rt_thread_mdelay(volnum);
  286. rt_pin_write(Beep, 0);
  287. }
  288. void Motor_Juandai(uint8_t on_off)
  289. {
  290. /* ★ pwm8_init() 失败时 pwm_tim8 为 NULL, 原代码不判空 -> hard fault */
  291. if (pwm8_init() != 0 || pwm_tim8 == RT_NULL)
  292. return;
  293. rt_pwm_set(pwm_tim8, PC7_TIM3_CH, 200000, 100000);//channel,period,pulse
  294. //
  295. if(on_off==ON){
  296. rt_pwm_enable(pwm_tim8, PC7_TIM3_CH);
  297. }
  298. else {
  299. rt_pwm_disable(pwm_tim8, PC7_TIM3_CH);
  300. }
  301. }
  302. void Motor_Qingsao_R_PWM(uint8_t on_off)
  303. {
  304. if (pwm8_init() != 0 || pwm_tim8 == RT_NULL)
  305. return;
  306. rt_pwm_set(pwm_tim8, PC7_TIM3_CH, 200000, 150000);//channel,period,pulse
  307. if(on_off==ON){
  308. rt_pwm_enable(pwm_tim8, PC7_TIM3_CH);
  309. }
  310. else {
  311. rt_pwm_disable(pwm_tim8, PC7_TIM3_CH);
  312. }
  313. }
  314. void Motor_Qingsao_L_PWM(uint8_t on_off)
  315. {
  316. if (pwm8_init() != 0 || pwm_tim8 == RT_NULL)
  317. return;
  318. rt_pwm_set(pwm_tim8, PC8_TIM3_CH, 200000, 150000);//channel,period,pulse
  319. if(on_off==ON)
  320. {
  321. rt_pwm_enable(pwm_tim8, PC8_TIM3_CH);
  322. }
  323. else {
  324. rt_pwm_disable(pwm_tim8, PC8_TIM3_CH);
  325. }
  326. }
  327. void Motor_shake(uint8_t status_shake,uint16_t shake_sec)
  328. {
  329. if (beep_init() != 0 || pwm_device == RT_NULL)
  330. return;
  331. rt_pwm_set(pwm_device, PB1_TIM3_CH, 200000, 150000);//channel,period,pulse
  332. if(status_shake==ON)
  333. {
  334. rt_pwm_enable(pwm_device, PB1_TIM3_CH);
  335. if(shake_sec!=0)
  336. {
  337. rt_thread_delay(shake_sec*1000);
  338. rt_pwm_disable(pwm_device, PB1_TIM3_CH);
  339. HMI_WRITE("cangWei.switchShake.val=%d",0);
  340. }
  341. }
  342. else {
  343. rt_pwm_disable(pwm_device, PB1_TIM3_CH);
  344. HMI_WRITE("cangWei.switchShake.val=%d",0);
  345. }
  346. }
  347. /* 导出到 msh 命令列表中 */
  348. MSH_CMD_EXPORT(hwtimer_sample, hwtimer sample);