mirror of
https://gitee.com/dlmu-cone/bf_original_balance_chassis
synced 2026-07-23 19:25:09 +08:00
将蜂鸣器警报和daemonTask分开
This commit is contained in:
@@ -1,88 +1,97 @@
|
||||
#include "bsp_pwm.h"
|
||||
#include "buzzer.h"
|
||||
#include "bsp_dwt.h"
|
||||
|
||||
#include "string.h"
|
||||
static PWMInstance *buzzer;
|
||||
|
||||
static alarm_level_e now_alarm_level = ALARM_OFFLINE;
|
||||
|
||||
void BuzzerOn(PWMInstance *buzzer );
|
||||
/**
|
||||
*
|
||||
* @brief 蜂鸣器报警函数
|
||||
* @param alarm_level 报警级别
|
||||
*/
|
||||
void BuzzerPlay(alarm_level_e alarm_level)
|
||||
{
|
||||
static alarm_level_e last_alarm_level = ALARM_LEVEL_LOW;
|
||||
|
||||
if(((int)DWT_GetTimeline_s() % 5)<1) //每5秒检查一次
|
||||
{
|
||||
last_alarm_level = ALARM_LEVEL_LOW;
|
||||
now_alarm_level = ALARM_OFFLINE;
|
||||
}
|
||||
|
||||
if(last_alarm_level <= now_alarm_level) //如果当前报警级别大于等于上一次报警级别,则更新报警级别
|
||||
{
|
||||
now_alarm_level = alarm_level;
|
||||
}
|
||||
last_alarm_level = alarm_level;
|
||||
|
||||
}
|
||||
static uint8_t idx;
|
||||
static BuzzzerInstance *buzzer_list[BUZZER_DEVICE_CNT] = {0};
|
||||
|
||||
/**
|
||||
* @brief 蜂鸣器初始化
|
||||
*
|
||||
*
|
||||
*/
|
||||
void buzzer_init()
|
||||
{
|
||||
PWM_Init_Config_s buzzer_config = {
|
||||
.htim = &htim4,
|
||||
.channel= TIM_CHANNEL_3,
|
||||
.period = 1,
|
||||
.pulse = 10000,
|
||||
.callback = BuzzerOn,
|
||||
.htim = &htim4,
|
||||
.channel= TIM_CHANNEL_3,
|
||||
.dutyratio = 0,
|
||||
.period = 0.001,
|
||||
};
|
||||
buzzer = PWMRegister(&buzzer_config);
|
||||
}
|
||||
/**
|
||||
* @brief 开启蜂鸣器
|
||||
*
|
||||
* @param buzzer
|
||||
*/
|
||||
//*@todo: 优化报警声,应类似D__,DDD,B__,BBB等报警声
|
||||
void BuzzerOn(PWMInstance *buzzer )
|
||||
|
||||
BuzzzerInstance *BuzzerRegister(Buzzer_config_s *config)
|
||||
{
|
||||
switch (now_alarm_level)
|
||||
if (config->alarm_level > BUZZER_DEVICE_CNT) // 超过最大实例数,考虑增加或查看是否有内存泄漏
|
||||
while (1)
|
||||
;
|
||||
BuzzzerInstance *buzzer_temp = (BuzzzerInstance *)malloc(sizeof(BuzzzerInstance));
|
||||
memset(buzzer_temp, 0, sizeof(BuzzzerInstance));
|
||||
|
||||
buzzer_temp->alarm_level = config->alarm_level;
|
||||
buzzer_temp->loudness = config->loudness;
|
||||
buzzer_temp->octave = config->octave;
|
||||
buzzer_temp->alarm_state = ALARM_OFF;
|
||||
|
||||
buzzer_list[config->alarm_level] = buzzer_temp;
|
||||
return buzzer_temp;
|
||||
|
||||
}
|
||||
|
||||
void AlarmSetStatus(BuzzzerInstance *buzzer, AlarmState_e state)
|
||||
{
|
||||
buzzer->alarm_state = state;
|
||||
}
|
||||
|
||||
void BuzzerTask()
|
||||
{
|
||||
BuzzzerInstance *buzz;
|
||||
for (size_t i = 0; i < BUZZER_DEVICE_CNT; ++i)
|
||||
{
|
||||
case ALARM_LEVEL_LOW:
|
||||
PWMSetPeriod(buzzer, 1);
|
||||
PWMSetPulse(buzzer, 10000);
|
||||
break;
|
||||
case ALARM_LEVEL_BELOW_MEDIUM:
|
||||
PWMSetPeriod(buzzer, 2);
|
||||
PWMSetPulse(buzzer, 10000);
|
||||
break;
|
||||
case ALARM_LEVEL_MEDIUM:
|
||||
PWMSetPeriod(buzzer, 3);
|
||||
PWMSetPulse(buzzer, 10000);
|
||||
break;
|
||||
case ALARM_LEVEL_ABOVE_MEDIUM:
|
||||
PWMSetPeriod(buzzer, 4);
|
||||
PWMSetPulse(buzzer, 10000);
|
||||
break;
|
||||
case ALARM_LEVEL_HIGH:
|
||||
PWMSetPeriod(buzzer, 5);
|
||||
PWMSetPulse(buzzer, 10000);
|
||||
break;
|
||||
|
||||
default:
|
||||
PWMSetPulse(buzzer, 0);
|
||||
break;
|
||||
buzz = buzzer_list[i];
|
||||
if(buzz->alarm_level > ALARM_LEVEL_LOW)
|
||||
{
|
||||
continue;
|
||||
}
|
||||
if(buzz->alarm_state == ALARM_OFF)
|
||||
{
|
||||
PWMSetDutyRatio(buzzer, 0);
|
||||
}
|
||||
else
|
||||
{
|
||||
PWMSetDutyRatio(buzzer, buzz->loudness);
|
||||
switch (buzz->octave)
|
||||
{
|
||||
case OCTAVE_1:
|
||||
PWMSetPeriod(buzzer, (float)1/DoFreq);
|
||||
break;
|
||||
case OCTAVE_2:
|
||||
PWMSetPeriod(buzzer, (float)1/ReFreq);
|
||||
break;
|
||||
case OCTAVE_3:
|
||||
PWMSetPeriod(buzzer, (float)1/MiFreq);
|
||||
break;
|
||||
case OCTAVE_4:
|
||||
PWMSetPeriod(buzzer, (float)1/FaFreq);
|
||||
break;
|
||||
case OCTAVE_5:
|
||||
PWMSetPeriod(buzzer, (float)1/SoFreq);
|
||||
break;
|
||||
case OCTAVE_6:
|
||||
PWMSetPeriod(buzzer, (float)1/LaFreq);
|
||||
break;
|
||||
case OCTAVE_7:
|
||||
PWMSetPeriod(buzzer, (float)1/SiFreq);
|
||||
break;
|
||||
}
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
@@ -1,7 +1,60 @@
|
||||
#ifndef BUZZER_H
|
||||
#define BUZZER_H
|
||||
#include "daemon.h"
|
||||
#include "bsp_pwm.h"
|
||||
#define BUZZER_DEVICE_CNT 5
|
||||
|
||||
#define DoFreq 523
|
||||
#define ReFreq 587
|
||||
#define MiFreq 659
|
||||
#define FaFreq 698
|
||||
#define SoFreq 784
|
||||
#define LaFreq 880
|
||||
#define SiFreq 988
|
||||
|
||||
typedef enum
|
||||
{
|
||||
OCTAVE_1 = 0,
|
||||
OCTAVE_2,
|
||||
OCTAVE_3,
|
||||
OCTAVE_4,
|
||||
OCTAVE_5,
|
||||
OCTAVE_6,
|
||||
OCTAVE_7,
|
||||
OCTAVE_8,
|
||||
}octave_e;
|
||||
|
||||
typedef enum
|
||||
{
|
||||
ALARM_LEVEL_HIGH = 0,
|
||||
ALARM_LEVEL_ABOVE_MEDIUM,
|
||||
ALARM_LEVEL_MEDIUM,
|
||||
ALARM_LEVEL_BELOW_MEDIUM,
|
||||
ALARM_LEVEL_LOW,
|
||||
}AlarmLevel_e;
|
||||
|
||||
typedef enum
|
||||
{
|
||||
ALARM_OFF = 0,
|
||||
ALARM_ON,
|
||||
}AlarmState_e;
|
||||
typedef struct
|
||||
{
|
||||
AlarmLevel_e alarm_level;
|
||||
octave_e octave;
|
||||
float loudness;
|
||||
}Buzzer_config_s;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
float loudness;
|
||||
octave_e octave;
|
||||
AlarmLevel_e alarm_level;
|
||||
AlarmState_e alarm_state;
|
||||
}BuzzzerInstance;
|
||||
|
||||
|
||||
void buzzer_init();
|
||||
|
||||
|
||||
void BuzzerTask();
|
||||
BuzzzerInstance *BuzzerRegister(Buzzer_config_s *config);
|
||||
void AlarmSetStatus(BuzzzerInstance *buzzer, AlarmState_e state);
|
||||
#endif // !BUZZER_H
|
||||
|
||||
20
modules/alarm/buzzer.md
Normal file
20
modules/alarm/buzzer.md
Normal file
@@ -0,0 +1,20 @@
|
||||
# buzzer
|
||||
|
||||
用于拉响蜂鸣器警报
|
||||
|
||||
## 使用范例
|
||||
|
||||
```c
|
||||
Buzzer_config_s buzzer_config ={
|
||||
.alarm_level = ALARM_LEVEL_HIGH, //设置警报等级 同一状态下 高等级的响应
|
||||
.loudness= 0.4, //设置响度
|
||||
.octave= OCTAVE_1, // 设置音阶
|
||||
};
|
||||
robocmd_alarm = BuzzerRegister(&buzzer_config);
|
||||
|
||||
AlarmSetStatus(robocmd_alarm, ALARM_ON);
|
||||
AlarmSetStatus(robocmd_alarm, ALARM_OFF);
|
||||
|
||||
```
|
||||
|
||||
@todo: 将音阶改为可供选择的搭配 如 Do Re Mi Fa So La Si 自由组合 用户只需输入字符串"DoReMi"即可
|
||||
@@ -18,8 +18,6 @@ DaemonInstance *DaemonRegister(Daemon_Init_Config_s *config)
|
||||
instance->callback = config->callback;
|
||||
instance->temp_count = config->init_count == 0 ? 100 : config->init_count; // 默认值为100,初始计数
|
||||
|
||||
instance->alarm_state = config->alarm_state;
|
||||
instance->alarm_level = config->alarm_level;
|
||||
instance->temp_count = config->reload_count;
|
||||
daemon_instances[idx++] = instance;
|
||||
return instance;
|
||||
@@ -49,11 +47,6 @@ void DaemonTask()
|
||||
{
|
||||
dins->callback(dins->owner_id); // module内可以将owner_id强制类型转换成自身类型从而调用特定module的offline callback
|
||||
// @todo 为蜂鸣器/led等增加离线报警的功能,非常关键!
|
||||
if(dins->alarm_state == ALARM_ON)
|
||||
{
|
||||
BuzzerPlay(dins->alarm_level);
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
@@ -8,28 +8,13 @@
|
||||
|
||||
/* 模块离线处理函数指针 */
|
||||
typedef void (*offline_callback)(void *);
|
||||
typedef enum
|
||||
{
|
||||
ALARM_OFF = 0,
|
||||
ALARM_ON = 1,
|
||||
}alarm_state_e;
|
||||
typedef enum
|
||||
{
|
||||
ALARM_LEVEL_LOW = 0,
|
||||
ALARM_LEVEL_BELOW_MEDIUM = 1,
|
||||
ALARM_LEVEL_MEDIUM = 2,
|
||||
ALARM_LEVEL_ABOVE_MEDIUM = 3,
|
||||
ALARM_LEVEL_HIGH = 4,
|
||||
ALARM_OFFLINE = 5,
|
||||
}alarm_level_e;
|
||||
|
||||
/* daemon结构体定义 */
|
||||
typedef struct daemon_ins
|
||||
{
|
||||
uint16_t reload_count; // 重载值
|
||||
offline_callback callback; // 异常处理函数,当模块发生异常时会被调用
|
||||
alarm_state_e alarm_state; // 蜂鸣器状态
|
||||
alarm_level_e alarm_level; //警报级别
|
||||
|
||||
|
||||
uint16_t temp_count; // 当前值,减为零说明模块离线或异常
|
||||
void *owner_id; // daemon实例的地址,初始化的时候填入
|
||||
} DaemonInstance;
|
||||
@@ -40,9 +25,7 @@ typedef struct
|
||||
uint16_t reload_count; // 实际上这是app唯一需要设置的值?
|
||||
uint16_t init_count; // 上线等待时间,有些模块需要收到主控的指令才会反馈报文,或pc等需要开机时间
|
||||
offline_callback callback; // 异常处理函数,当模块发生异常时会被调用
|
||||
alarm_state_e alarm_state; // 蜂鸣器状态
|
||||
alarm_level_e alarm_level; //警报级别
|
||||
|
||||
|
||||
void *owner_id; // id取拥有daemon的实例的地址,如DJIMotorInstance*,cast成void*类型
|
||||
} Daemon_Init_Config_s;
|
||||
|
||||
|
||||
Reference in New Issue
Block a user