| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393 |
- /*
- * Copyright (c) 2006-2020, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2020-05-23 Administrator the first version
- */
- #include <rtdevice.h> //使用 RT-Thread 的设备需要包含此头文件
- #include <beep.h>
- #include <control.h>
- #include "hmi.h"
- #define HWTIMER_DEV_NAME "timer2" /* 定时器名称 */
- /* device_status 已收敛为全工程唯一定义(在 main.c), 此处不再重复定义, 见 control.h 的 extern 声明 */
- struct rt_device_pwm *pwm_device = RT_NULL; //定义 pwm 设备指针
- struct rt_device_pwm *pwm_tim8 = RT_NULL; //定义 pwm 设备指针
- /* 定时器设备句柄(文件作用域, 供 beep_timer_release() 在线程上下文收尾) */
- rt_device_t hw_dev = RT_NULL;
- /* ★ ISR 里只允许置标志 + 纯 HAL 操作, 不允许任何可能阻塞的 API。
- g_beep_timer_fired: hwtimer one-shot 已到期, 由线程上下文的 beep_timer_release() 收尾。 */
- static volatile uint8_t g_beep_timer_fired = 0;
- /* 定时器超时回调函数(硬件定时器中断上下文) */
- static rt_err_t timeout_cb(rt_device_t dev, rt_size_t size)
- {
- /* ★ 原实现在 ISR 里做了三件不该做的事:
- ① rt_kprintf -> 走 console 设备 rt_device_write, 发送未完成时会在完成量上等待;
- ② rt_device_close -> 内部有 RT_ASSERT 且会调 dev->close(), 属线程上下文 API;
- 这两者在中断里调用会死锁在 ISR 内, 整机停死后 5s 看门狗复位,
- 现象是"蜂鸣器响/电机走到限位时随机死机"。
- 现在只置标志 + 关 PWM(rt_pwm_disable 走 HAL, 不取任何 IPC 锁)。 */
- g_beep_timer_fired = 1;
- if (pwm_device != RT_NULL)
- {
- rt_pwm_disable(pwm_device, BEEP_PWM_CH);
- }
- return 0;
- }
- /* 线程上下文: 关掉上一次 one-shot 到期后遗留的 hwtimer 设备句柄。
- 不能在 timeout_cb 里 close(见上), 放在下一次 init_tim2() 开头收尾。 */
- static void beep_timer_release(void)
- {
- if (g_beep_timer_fired && hw_dev != RT_NULL)
- {
- rt_device_close(hw_dev);
- hw_dev = RT_NULL;
- }
- g_beep_timer_fired = 0;
- }
- static int hwtimer_sample(int argc, char *argv[])
- {
- rt_err_t ret = RT_EOK;
- rt_hwtimerval_t timeout_s; /* 定时器超时值 */
- rt_device_t hw_dev = RT_NULL; /* 定时器设备句柄 */
- rt_hwtimer_mode_t mode; /* 定时器模式 */
- rt_uint32_t freq = 10000; /* 计数频率 */
- /* 查找定时器设备 */
- hw_dev = rt_device_find(HWTIMER_DEV_NAME);
- if (hw_dev == RT_NULL)
- {
- rt_kprintf("hwtimer sample run failed! can't find %s device!\n", HWTIMER_DEV_NAME);
- return RT_ERROR;
- }
- /* 以读写方式打开设备 */
- ret = rt_device_open(hw_dev, RT_DEVICE_OFLAG_RDWR);
- if (ret != RT_EOK)
- {
- rt_kprintf("open %s device failed!\n", HWTIMER_DEV_NAME);
- return ret;
- }
- /* 设置超时回调函数 */
- rt_device_set_rx_indicate(hw_dev, timeout_cb);
- /* 设置计数频率(若未设置该项,默认为1Mhz 或 支持的最小计数频率) */
- rt_device_control(hw_dev, HWTIMER_CTRL_FREQ_SET, &freq);
- /* 设置模式为周期性定时器(若未设置,默认是HWTIMER_MODE_ONESHOT)*/
- mode = HWTIMER_MODE_PERIOD; //HWTIMER_MODE_ONESHOT;
- ret = rt_device_control(hw_dev, HWTIMER_CTRL_MODE_SET, &mode);
- if (ret != RT_EOK)
- {
- rt_kprintf("set mode failed! ret is :%d\n", ret);
- return ret;
- }
- /* 设置定时器超时值为5s并启动定时器 */
- timeout_s.sec = 10; /* 秒 */
- timeout_s.usec = 0; /* 微秒 */
- if (rt_device_write(hw_dev, 0, &timeout_s, sizeof(timeout_s)) != sizeof(timeout_s))
- {
- rt_kprintf("set timeout value failed\n");
- return RT_ERROR;
- }
- //beep_init();
- hwtimer2_pwm3_output(0,20000,1,1);
- return ret;
- }
- /*初始化蜂鸣器*/
- int beep_init(void)
- {
- /*查找PWM设备*/
- pwm_device = (struct rt_device_pwm *)rt_device_find(BEEP_PWM_DEVICE);
- if(pwm_device==RT_NULL)
- {
- rt_kprintf("pwm device %s not found!\n", BEEP_PWM_DEVICE);
- return -RT_ERROR;
- }
- return 0;
- }
- static int init_pwm3(void)
- {
- /*查找PWM设备*/
- pwm_device = (struct rt_device_pwm *)rt_device_find(BEEP_PWM_DEVICE);
- if(pwm_device==RT_NULL)
- {
- rt_kprintf("pwm device %s not found!\n", BEEP_PWM_DEVICE);
- return -RT_ERROR;
- }
- return 0;
- }
- static int init_tim2(void)
- {
- rt_err_t ret = RT_EOK;
- rt_hwtimerval_t timeout_s; /* 定时器超时值 */
- rt_hwtimer_mode_t mode; /* 定时器模式 */
- rt_uint32_t freq = 10000; /* 计数频率 */
- /* ★ 原来这里又声明了一个同名的局部 hw_dev, 把文件作用域的 hw_dev 整个屏蔽掉,
- 函数一返回句柄就丢了, beep_timer_release() 无从收尾。改用全局那份。 */
- beep_timer_release();
- /* 查找定时器设备 */
- hw_dev = rt_device_find(HWTIMER_DEV_NAME);
- if (hw_dev == RT_NULL)
- {
- rt_kprintf("hwtimer sample run failed! can't find %s device!\n", HWTIMER_DEV_NAME);
- return RT_ERROR;
- }
- /* 以读写方式打开设备 */
- ret = rt_device_open(hw_dev, RT_DEVICE_OFLAG_RDWR);
- if (ret != RT_EOK)
- {
- rt_kprintf("open %s device failed!\n", HWTIMER_DEV_NAME);
- return ret;
- }
- /* 设置超时回调函数 */
- rt_device_set_rx_indicate(hw_dev, timeout_cb);
- /* 设置计数频率(若未设置该项,默认为1Mhz 或 支持的最小计数频率) */
- rt_device_control(hw_dev, HWTIMER_CTRL_FREQ_SET, &freq);
- /* 设置模式为周期性定时器(若未设置,默认是HWTIMER_MODE_ONESHOT)*/
- mode = HWTIMER_MODE_ONESHOT; //HWTIMER_MODE_ONESHOT;
- ret = rt_device_control(hw_dev, HWTIMER_CTRL_MODE_SET, &mode);
- if (ret != RT_EOK)
- {
- rt_kprintf("set mode failed! ret is :%d\n", ret);
- return ret;
- }
- /* 设置定时器超时值为5s并启动定时器 */
- timeout_s.sec = 0; /* 秒 */
- timeout_s.usec = 500000; /* 微秒 */ //100ms
- if (rt_device_write(hw_dev, 0, &timeout_s, sizeof(timeout_s)) != sizeof(timeout_s))
- {
- rt_kprintf("set timeout value failed\n");
- return RT_ERROR;
- }
- return 0;
- }
- int hwtimer2_pwm3_output(rt_uint32_t time,rt_uint32_t freq,uint8_t EN,uint8_t DIR)
- {
- ctr_Motor_Driver_Power(ON);
- rt_thread_delay(100);
- rt_pin_mode(Motor_EN, PIN_MODE_OUTPUT);
- rt_pin_mode(Motor_DIR, PIN_MODE_OUTPUT);
- rt_pin_write(Motor_EN, EN);
- rt_thread_delay(1);
- rt_pin_write(Motor_DIR, DIR);
- /* ★ init_pwm3() 失败时 pwm_device 为 NULL, 原代码不判空直接传给 rt_pwm_set/enable
- -> 解引用空 struct rt_device_pwm -> hard fault。 */
- if (init_pwm3() != 0 || pwm_device == RT_NULL)
- {
- rt_kprintf("hwtimer2_pwm3_output: pwm3 not available!\n");
- return -RT_ERROR;
- }
- rt_pwm_set(pwm_device, BEEP_PWM_CH, freq, freq/2);//channel,period,pulse
- if(init_tim2()==0)
- rt_pwm_enable(pwm_device, BEEP_PWM_CH); //使能蜂鸣器对应的 PWM 通道
- return 0;
- }
- /* 86 电机限位中断回调(GPIO 中断上下文)
- ★ 形参必须是 void *args: rt_pin_attach_irq 要求的类型是 void (*)(void *),
- 原来声明成 void(void), 属函数指针类型不匹配(未定义行为)。 */
- static void stop_motor_86(void *args)
- {
- (void)args;
- /* ★ 原来是 rt_kprintf + 无判空的 rt_pwm_disable。
- rt_kprintf 在中断里走 console 设备写, 可能阻塞 -> 死锁在 ISR。
- PWM 句柄为空时 rt_pwm_disable 会解引用空 struct -> hard fault。 */
- if (pwm_device != RT_NULL)
- {
- rt_pwm_disable(pwm_device, BEEP_PWM_CH);
- }
- }
- void pin_motor_86_bind(void)
- {
- rt_pin_mode(MOTOR_86, PIN_MODE_INPUT);
- /* 绑定中断,下降沿模式,回调函数名为 */
- rt_pin_attach_irq(MOTOR_86, PIN_IRQ_MODE_FALLING, stop_motor_86, RT_NULL);
- /* 使能中断 */
- rt_pin_irq_enable(MOTOR_86, PIN_IRQ_ENABLE);
- }
- void pin_motor_86_unbind(void)
- {
- rt_pin_detach_irq(MOTOR_86);
- }
- /*打开蜂鸣器*/
- int pwm_on(uint8_t pwn_ch,rt_uint32_t pwm_freq)
- {
- /* ★ PWM 句柄判空(与 beep_init 等价, 找不到设备时返回非 0) */
- if (pwm_device == RT_NULL && beep_init() != 0)
- return -RT_ERROR;
- rt_pwm_set(pwm_device, pwn_ch, pwm_freq, pwm_freq/2);
- rt_pwm_enable(pwm_device, pwn_ch); //使能蜂鸣器对应的 PWM 通道
- return 0;
- }
- /*关闭蜂鸣器*/
- int pwm_off(uint8_t pwn_ch,rt_uint32_t pwm_freq)
- {
- if (pwm_device == RT_NULL && beep_init() != 0)
- return -RT_ERROR;
- rt_pwm_set(pwm_device, pwn_ch, pwm_freq, 0);
- rt_pwm_disable(pwm_device, pwn_ch); //使能蜂鸣器对应的 PWM 通道
- return 0;
- }
- int pwm8_init(void)
- {
- pwm_tim8 = (struct rt_device_pwm *)rt_device_find("pwm8");
- if(pwm_tim8==RT_NULL)
- {
- rt_kprintf("pwm device pwm8 not found!\n");
- return -RT_ERROR;
- }
- return 0;
- }
- /*打开蜂鸣器*/
- int beep_on(void)
- {
- if (pwm_device == RT_NULL && beep_init() != 0)
- return -RT_ERROR;
- rt_pwm_enable(pwm_device, BEEP_PWM_CH); //使能蜂鸣器对应的 PWM 通道
- return 0;
- }
- /*关闭蜂鸣器*/
- int beep_off(void)
- {
- if (pwm_device == RT_NULL && beep_init() != 0)
- return -RT_ERROR;
- rt_pwm_disable(pwm_device, BEEP_PWM_CH); //失能蜂鸣器对应的 PWM 通道
- return 0;
- }
- /*在蜂鸣器设定函数里需要设定 蜂鸣器的频率和音量。PWM 设备设定的 API 是设定 周期 和 脉宽 的,
- * 因此我们需要转换一下,将频率装换成周期,将音量大小(占空比)转换成脉宽。这里的周期的单位是 ns,
- * 因此转换成的 秒 之后还要乘以 10^9 。由于无源蜂鸣器一般是低电平触发的,因此音量越大对应的脉宽就要越小。
- * 然后,将转换后的数据传入 rt_pwm_set 来设置 PWM 设备的参数。
- *
- */
- void beep_set(uint32_t freq, uint32_t volume)
- {
- rt_uint32_t period, pulse;
- /* ★ beep_init() 失败时 pwm_device 仍是 NULL, 原代码不判空继续用 -> hard fault */
- if (beep_init() != 0 || pwm_device == RT_NULL)
- return;
- /* 将频率转化为周期 周期单位:ns 频率单位:HZ */
- //period = 1000000000 / freq; //unit:ns 1/HZ*10^9 = ns
- period = freq; /* 周期为0.5ms,单位为纳秒500000ns-200k */
- /* 根据声音大小计算占空比 蜂鸣器低电平触发 */
- pulse = volume; //5000
- if(freq==0)
- {
- rt_pwm_disable(pwm_device, BEEP_PWM_CH);
- }else {
- /* 利用 PWM API 设定 周期和占空比 */
- rt_pwm_set(pwm_device, BEEP_PWM_CH, period, pulse);//channel,period,pulse
- rt_pwm_enable(pwm_device, BEEP_PWM_CH);
- }
- }
- void Beep_Tip(uint16_t volnum)
- {
- rt_pin_mode(Beep, PIN_MODE_OUTPUT);
- rt_pin_write(Beep, 1);
- rt_thread_mdelay(volnum);
- rt_pin_write(Beep, 0);
- }
- void Motor_Juandai(uint8_t on_off)
- {
- /* ★ pwm8_init() 失败时 pwm_tim8 为 NULL, 原代码不判空 -> hard fault */
- if (pwm8_init() != 0 || pwm_tim8 == RT_NULL)
- return;
- rt_pwm_set(pwm_tim8, PC7_TIM3_CH, 200000, 100000);//channel,period,pulse
- //
- if(on_off==ON){
- rt_pwm_enable(pwm_tim8, PC7_TIM3_CH);
- }
- else {
- rt_pwm_disable(pwm_tim8, PC7_TIM3_CH);
- }
- }
- void Motor_Qingsao_R_PWM(uint8_t on_off)
- {
- if (pwm8_init() != 0 || pwm_tim8 == RT_NULL)
- return;
- rt_pwm_set(pwm_tim8, PC7_TIM3_CH, 200000, 150000);//channel,period,pulse
- if(on_off==ON){
- rt_pwm_enable(pwm_tim8, PC7_TIM3_CH);
- }
- else {
- rt_pwm_disable(pwm_tim8, PC7_TIM3_CH);
- }
- }
- void Motor_Qingsao_L_PWM(uint8_t on_off)
- {
- if (pwm8_init() != 0 || pwm_tim8 == RT_NULL)
- return;
- rt_pwm_set(pwm_tim8, PC8_TIM3_CH, 200000, 150000);//channel,period,pulse
- if(on_off==ON)
- {
- rt_pwm_enable(pwm_tim8, PC8_TIM3_CH);
- }
- else {
- rt_pwm_disable(pwm_tim8, PC8_TIM3_CH);
- }
- }
- void Motor_shake(uint8_t status_shake,uint16_t shake_sec)
- {
- if (beep_init() != 0 || pwm_device == RT_NULL)
- return;
- rt_pwm_set(pwm_device, PB1_TIM3_CH, 200000, 150000);//channel,period,pulse
- if(status_shake==ON)
- {
- rt_pwm_enable(pwm_device, PB1_TIM3_CH);
- if(shake_sec!=0)
- {
- rt_thread_delay(shake_sec*1000);
- rt_pwm_disable(pwm_device, PB1_TIM3_CH);
- HMI_WRITE("cangWei.switchShake.val=%d",0);
- }
- }
- else {
- rt_pwm_disable(pwm_device, PB1_TIM3_CH);
- HMI_WRITE("cangWei.switchShake.val=%d",0);
- }
- }
- /* 导出到 msh 命令列表中 */
- MSH_CMD_EXPORT(hwtimer_sample, hwtimer sample);
|