增加发车和停车菜单
增加停车相关条件开关功能
pref:
弯道速度控制一次函数->二次函数
删除图像下发无意义的0状态
fix:
修复下位机多次复位才能触发上位机复位
This commit is contained in:
2024-08-12 18:08:46 +08:00
parent 92eaf372ff
commit 06004e9e0b
14 changed files with 378 additions and 110 deletions

View File

@@ -4,15 +4,15 @@
bool bt_rx_flag = false; bool bt_rx_flag = false;
uint8_t bt_buffer; // 接收字符存入 uint8_t bt_buffer; // 接收字符存入
uint8_t bt_run_flag = 0; uint8_t bt_run_flag = 0;
uint8_t bt_fly_flag = 0; uint8_t bt_fly_flag = 0;
uint32_t bt_run = 0; uint32_t bt_run = 0;
float bt_fly = 160.f; float bt_fly = 160.f;
enum bt_order { enum bt_order {
Fly_ctrl = 0x01, // 起飞转换 Fly_ctrl = 0x01, // 起飞转换
Fly_up = 0x02, // 起飞程度增加 Fly_up = 0x02, // 起飞程度增加
Fly_dowm = 0x03, // 起飞程度减小 Fly_dowm = 0x03, // 起飞程度减小
Speed_up = 0x04, // 加速 fly_close = 0x04, // 加速
Speed_down = 0x05, // 减速 run_close = 0x05, // 全关
Speed_ctrl = 0x06, // 速度开关 Speed_ctrl = 0x06, // 速度开关
Reset, Reset,
}; };
@@ -34,10 +34,21 @@ void jj_bt_run()
if (bt_rx_flag) { if (bt_rx_flag) {
switch (bt_buffer) { switch (bt_buffer) {
case Fly_ctrl: case Fly_ctrl:
bt_fly_flag = !bt_fly_flag;
if (go_cnt == 0) {
go_cnt = 1;
bt_fly_flag = 1;
}
else if (go_cnt == 1) {
go_cnt = 0;
}
break; break;
case Speed_ctrl: case Speed_ctrl:
bt_run_flag = !bt_run_flag; if (go_cnt == 1) {
go_cnt = 2;
}
break; break;
case Fly_up: case Fly_up:
bt_fly += 10; bt_fly += 10;
@@ -45,11 +56,13 @@ void jj_bt_run()
case Fly_dowm: case Fly_dowm:
bt_fly -= 10; bt_fly -= 10;
break; break;
case Speed_up: case run_close:
bt_run += 50; bt_run_flag = 0;
go_cnt = 0;
break; break;
case Speed_down: case fly_close:
bt_run -= 50; bt_fly_flag = 0;
go_cnt = 0;
break; break;
case Reset: case Reset:
NVIC_SystemReset(); NVIC_SystemReset();
@@ -70,8 +83,7 @@ void bt_printf(const char *format, ...)
va_end(args); va_end(args);
for (uint16_t i = 0; i < strlen(sbuf); i++) { for (uint16_t i = 0; i < strlen(sbuf); i++) {
while (USART_GetFlagStatus((USART_TypeDef *)uart_index[UART_7], USART_FLAG_TC) == RESET) while (USART_GetFlagStatus((USART_TypeDef *)uart_index[UART_7], USART_FLAG_TC) == RESET);
;
USART_SendData((USART_TypeDef *)uart_index[UART_7], sbuf[i]); USART_SendData((USART_TypeDef *)uart_index[UART_7], sbuf[i]);
} }
} }

View File

@@ -13,6 +13,7 @@ extern bool bt_rx_flag;
extern uint8_t bt_buffer; // 接收字符存入 extern uint8_t bt_buffer; // 接收字符存入
extern uint8_t bt_run_flag; extern uint8_t bt_run_flag;
extern uint8_t bt_fly_flag; extern uint8_t bt_fly_flag;
extern uint8_t bt_ce_flag;
extern uint32_t bt_run; extern uint32_t bt_run;
extern float bt_fly; extern float bt_fly;

View File

@@ -86,23 +86,23 @@ float in_speed;
float out_speed; float out_speed;
float last_angle; float last_angle;
float set_speed; float set_speed;
float set_speed0 = 657.0f; float set_speed0 = 657.0f;
float set_speed1 = 1111.0f; float set_speed1 = 1111.0f;
float set_speed2 = 815.f; float set_speed2 = 815.f;
float set_speed3 = 666.f; float set_speed3 = 666.f;
float set_speed4 = 720.f; float set_speed4 = 720.f;
int cnt1 = 0; int cnt1 = 0;
int cnt2 = 0; int cnt2 = 0;
int cnt3 = 0; // int cnt3 = 0;
int cnt4 = 0; // int cnt4 = 0; //
int cnt5 = 0; int cnt5 = 0;
int cnt6 = 0; // int cnt6 = 0; //
int cnt7 = 0; int cnt7 = 0;
int cnt8 = 0; int cnt8 = 0;
int cnt9 = 0; // int cnt9 = 0; //
int cnt10 = 0; // int cnt10 = 0; //
int if_start = 0; int if_start = 0;
float shock_stop = 0;
uint8_t in_state = 0; uint8_t in_state = 0;
uint8_t in_stop = 0; uint8_t in_stop = 0;
uint8_t last_state = 0; uint8_t last_state = 0;
@@ -111,12 +111,14 @@ int32_t pwm_duty_ls;
int32_t pwm_duty_rs; int32_t pwm_duty_rs;
int32_t pwm_duty_lb; int32_t pwm_duty_lb;
int32_t pwm_duty_rb; int32_t pwm_duty_rb;
int32_t stop_cnt = 0; int32_t stop_cnt = 0;
int32_t last_lb = 0; int32_t last_lb = 0;
int32_t last_rb = 0; int32_t last_rb = 0;
float start_dis = 0; float start_dis = 0;
int32_t game_over_flag = 0; // 任务结束 uint8_t go_cnt = 0;//0 停车 1 测试侧向风扇 2 启动 3成功运行
uint8_t go_flag = 0; float bug_sw = 0;
float out_sw = 0;
float sho_sw = 0;
/* /*
0:无状态 0:无状态
1:弯道 1:弯道
@@ -154,33 +156,36 @@ void sport_motion()
in_gyro = imu660ra_gyro_z; in_gyro = imu660ra_gyro_z;
////////////////////////////////////////停车任务/////////////////////////////////////////////// ////////////////////////////////////////停车任务///////////////////////////////////////////////
// 抖动停车 // 抖动停车计次50
if (imu660ra_acc_z <= 800) { if (imu660ra_acc_z <= 900) {
cnt7++; cnt7++;
} else { } else {
cnt7 = 0; cnt7 = 0;
} }
if (cnt7 >= 50 && ((uint32_t)shock_stop == 1 || (uint32_t)shock_stop == 2)) { if (cnt7 >= 10 && (uint8_t)sho_sw == 1) {
bt_fly_flag = bt_run_flag = 0; bt_fly_flag = bt_run_flag = 0;
bt_printf("up"); bt_printf("up");
go_cnt = 0;
} }
// 異常值停车 // 異常值停车
if (fabs(in_angle - last_angle) > 45.f && ((uint32_t)shock_stop == 1 || (uint32_t)shock_stop == 3)) { if (fabs(in_angle - last_angle) > 45.f && (uint8_t)bug_sw == 1) {
bt_fly_flag = bt_run_flag = 0; bt_fly_flag = bt_run_flag = 0;
bt_printf("bug"); bt_printf("bug");
go_cnt = 0;
} }
// 斑马线停车,摄像头识别 // 斑马线停车,摄像头识别,屏蔽发车前的十秒钟
if (1 == in_stop && if_start == 1) { if (1 == in_stop && if_start == 1) {
stop_flag = 1; stop_flag = 1;
} }
if (stop_flag == 1) { if (stop_flag == 1) {
bt_printf("finish"); bt_printf("finish");
bt_fly_flag = bt_run_flag = 0; bt_fly_flag = bt_run_flag = 0;
game_over_flag = 1; go_cnt = 0;
} }
// 出界停车,已经积分路过斑马线,保证斑马线不会触发 // 出界停车,已经积分路过斑马线,保证斑马线不会触发
if (2 == in_stop && start_dis >= 1) { if (2 == in_stop && (start_dis >= 1 || bt_run_flag == 0) && (uint8_t)out_sw == 1) {
bt_printf("out"); bt_printf("out");
go_cnt = 0;
bt_fly_flag = bt_run_flag = 0; bt_fly_flag = bt_run_flag = 0;
} }
@@ -189,15 +194,17 @@ void sport_motion()
cnt1++; cnt1++;
cnt2++; cnt2++;
cnt5++; cnt5++;
// 斑马线积分,系数随便给的
start_dis += in_speed * 0.000001;
if (if_start == 0) { if (if_start == 0) {
cnt8++; cnt8++;
start_dis += in_speed * 0.000001; // 斑马线积分
if (cnt8 >= 5000) { if (cnt8 >= 5000) {
if_start = 1; if_start = 1;
} }
} }
// pid参数切换 // pid参数切换
if ((last_state != in_state) && (in_state == 0 || in_state == 2)) { // 直道 if ((last_state != in_state) && (in_state == 2)) { // 直道
bt_printf("to 直道"); bt_printf("to 直道");
set_speed = set_speed1; set_speed = set_speed1;
@@ -232,9 +239,9 @@ void sport_motion()
} }
if (in_state == 1) { if (in_state == 1) {
set_speed = set_speed0 - fabs(rate_K * myclip_f(in_pos, -100.f, 100.f)); set_speed = set_speed0 - fabs(rate_K * powf(myclip_f(in_pos, -50.f, 50.f), 2));
} }
// 记录上一次状态
last_state = in_state; last_state = in_state;
// pid计算 // pid计算
if (cnt1 >= 2) { if (cnt1 >= 2) {
@@ -278,28 +285,26 @@ void sport_motion()
by_pwm_power_duty(0, 0, 0, 0); by_pwm_power_duty(0, 0, 0, 0);
} }
///////////////////////////////////////////////////* 升力风扇设置 */ ///////////////////////////////////////////////////////////////////////////////////////////////// ///////////////////////////////////////////////////* 升力风扇设置 */ /////////////////////////////////////////////////////////////////////////////////////////////////
if (bt_fly_flag == 0) { if (bt_fly_flag == 1) {
if (game_over_flag == 0) { by_pwm_update_duty(bt_fly + 500, bt_fly + 500);
by_pwm_update_duty(500, 500); if (bt_run_flag == 0) {
} else { // 测试状态
by_pwm_update_duty(700, 700); if (go_cnt == 1) {
by_pwm_power_duty(550, 550, 3000, 3000);
}
else if (2 == go_cnt) {
by_pwm_power_duty(550, 550, 4000, 4000);
cnt3++;
if(cnt3>=2000)
{
bt_run_flag=1;
go_cnt=3;
cnt3=0;
}
}
} }
} else { } else {
if (in_state == 1) { by_pwm_update_duty(500, 500);
by_pwm_update_duty(bt_fly + 500 + in_pos, bt_fly + 500 + in_pos);
} else {
by_pwm_update_duty(bt_fly + 500, bt_fly + 500);
}
// 防止起步拉满
if (bt_run_flag == 0&&go_flag==1) {
by_pwm_power_duty(550, 550, 3000, 3000);
}
else if(bt_run_flag == 0&&go_flag==2)
{
by_pwm_power_duty(550, 550, 4000, 4000);
}
} }
} }

View File

@@ -57,17 +57,20 @@ extern float set_speed2;
extern float set_speed3; extern float set_speed3;
extern float set_speed; extern float set_speed;
extern float set_speed4; extern float set_speed4;
extern float shock_stop;
extern float last_angle; extern float last_angle;
extern float yuc_Kp; extern float yuc_Kp;
extern float rate_K; extern float rate_K;
extern float start_dis;
extern int32_t pwm_duty_ls; extern int32_t pwm_duty_ls;
extern int32_t pwm_duty_rs; extern int32_t pwm_duty_rs;
extern int32_t pwm_duty_lb; extern int32_t pwm_duty_lb;
extern int32_t pwm_duty_rb; extern int32_t pwm_duty_rb;
extern uint8_t go_flag; extern uint8_t go_cnt;
extern uint8_t in_state; extern uint8_t in_state;
extern uint8_t in_stop; extern uint8_t in_stop;
extern float bug_sw;
extern float out_sw;
extern float sho_sw;
void sport_pid_init(); void sport_pid_init();
void sport_motion(void); void sport_motion(void);
#endif #endif

View File

@@ -17,9 +17,9 @@ TYPE_UNION temp_frame_param[20];
void jj_param_eeprom_init(void) void jj_param_eeprom_init(void)
{ {
soft_iic_init(&eeprom_param, K24C02_DEV_ADDR, K24C02_SOFT_IIC_DELAY, K24C02_SCL_PIN, K24C02_SDA_PIN); // eeprom初始化 soft_iic_init(&eeprom_param, K24C02_DEV_ADDR, K24C02_SOFT_IIC_DELAY, K24C02_SCL_PIN, K24C02_SDA_PIN); // eeprom初始化
//////////////////////////////////////////////////////////////////////// ////////////////////////////////////////////////////////////////////////
PARAM_REG(angle_Kp0, &an_Kp0, EFLOAT, 1, "an_P0:"); // 注冊 PARAM_REG(angle_Kp0, &an_Kp0, EFLOAT, 1, "an_P0:"); // 注冊
PARAM_REG(angle_Ki0, &an_Ki0, EFLOAT, 1, "an_I0:"); // 注冊 PARAM_REG(angle_Ki0, &an_Ki0, EFLOAT, 1, "an_I0:"); // 注冊
PARAM_REG(angle_Kd0, &an_Kd0, EFLOAT, 1, "an_D0:"); PARAM_REG(angle_Kd0, &an_Kd0, EFLOAT, 1, "an_D0:");
PARAM_REG(gyro_Kp0, &gy_Kp0, EFLOAT, 1, "gy_P0:"); // 注冊 PARAM_REG(gyro_Kp0, &gy_Kp0, EFLOAT, 1, "gy_P0:"); // 注冊
@@ -33,7 +33,7 @@ void jj_param_eeprom_init(void)
PARAM_REG(fly_pwm, &bt_fly, EFLOAT, 1, "fly:"); PARAM_REG(fly_pwm, &bt_fly, EFLOAT, 1, "fly:");
PARAM_REG(param_set_speed0, &set_speed0, EFLOAT, 1, "rate0:"); PARAM_REG(param_set_speed0, &set_speed0, EFLOAT, 1, "rate0:");
///////////////////////////////////////////////////////////////////// /////////////////////////////////////////////////////////////////////
PARAM_REG(angle_Kp1, &an_Kp1, EFLOAT, 1, "an_P1:"); // 注冊 PARAM_REG(angle_Kp1, &an_Kp1, EFLOAT, 1, "an_P1:"); // 注冊
PARAM_REG(angle_Ki1, &an_Ki1, EFLOAT, 1, "an_I1:"); // 注冊 PARAM_REG(angle_Ki1, &an_Ki1, EFLOAT, 1, "an_I1:"); // 注冊
PARAM_REG(angle_Kd1, &an_Kd1, EFLOAT, 1, "an_D1:"); PARAM_REG(angle_Kd1, &an_Kd1, EFLOAT, 1, "an_D1:");
@@ -47,7 +47,7 @@ void jj_param_eeprom_init(void)
PARAM_REG(pos_Kd1, &po_Kd1, EFLOAT, 1, "po_D1:"); PARAM_REG(pos_Kd1, &po_Kd1, EFLOAT, 1, "po_D1:");
PARAM_REG(param_set_speed1, &set_speed1, EFLOAT, 1, "rate1:"); PARAM_REG(param_set_speed1, &set_speed1, EFLOAT, 1, "rate1:");
///////////////////////////////////////////////////////////////////////// /////////////////////////////////////////////////////////////////////////
PARAM_REG(yuan_Kp0, &yu_Kp0, EFLOAT, 1, "an_P0:"); // 注冊 PARAM_REG(yuan_Kp0, &yu_Kp0, EFLOAT, 1, "an_P0:"); // 注冊
PARAM_REG(yuan_Ki0, &yu_Ki0, EFLOAT, 1, "an_I0:"); // 注冊 PARAM_REG(yuan_Ki0, &yu_Ki0, EFLOAT, 1, "an_I0:"); // 注冊
PARAM_REG(yuan_Kd0, &yu_Kd0, EFLOAT, 1, "an_D0:"); PARAM_REG(yuan_Kd0, &yu_Kd0, EFLOAT, 1, "an_D0:");
@@ -63,7 +63,7 @@ void jj_param_eeprom_init(void)
PARAM_REG(param_set_speed2, &set_speed2, EFLOAT, 1, "rate2:"); PARAM_REG(param_set_speed2, &set_speed2, EFLOAT, 1, "rate2:");
PARAM_REG(param_set_speed3, &set_speed3, EFLOAT, 1, "rate3:"); PARAM_REG(param_set_speed3, &set_speed3, EFLOAT, 1, "rate3:");
///////////////////////////////////////////////////////////// /////////////////////////////////////////////////////////////
PARAM_REG(zhan_Kp, &za_Kp, EFLOAT, 1, "an_P:"); // 注冊 PARAM_REG(zhan_Kp, &za_Kp, EFLOAT, 1, "an_P:"); // 注冊
PARAM_REG(zhan_Ki, &za_Ki, EFLOAT, 1, "an_I:"); // 注冊 PARAM_REG(zhan_Ki, &za_Ki, EFLOAT, 1, "an_I:"); // 注冊
PARAM_REG(zhan_Kd, &za_Kd, EFLOAT, 1, "an_D:"); PARAM_REG(zhan_Kd, &za_Kd, EFLOAT, 1, "an_D:");
@@ -76,8 +76,10 @@ void jj_param_eeprom_init(void)
PARAM_REG(zhpo_Kd, &zp_Kd, EFLOAT, 1, "po_D1:"); PARAM_REG(zhpo_Kd, &zp_Kd, EFLOAT, 1, "po_D1:");
PARAM_REG(param_set_speed4, &set_speed4, EFLOAT, 1, "rate4:"); PARAM_REG(param_set_speed4, &set_speed4, EFLOAT, 1, "rate4:");
PARAM_REG(shock, &shock_stop, EFLOAT, 1, "shock:"); PARAM_REG(bug_stop, &bug_sw, EFLOAT, 1, "bug:"); // 注冊
PARAM_REG(out_stop, &out_sw, EFLOAT, 1, "out:"); // 注冊
PARAM_REG(shock_stop, &sho_sw, EFLOAT, 1, "shock:");
jj_param_read(); // 注冊 jj_param_read(); // 注冊
} }
/** /**

View File

@@ -76,9 +76,13 @@ typedef enum {
zhpo_Ki, zhpo_Ki,
zhpo_Kd, zhpo_Kd,
shock,
param_set_speed4, param_set_speed4,
Page5_head,
bug_stop = Page5_head,
shock_stop,
out_stop,
DATA_IN_FLASH_NUM, DATA_IN_FLASH_NUM,
delta_x, delta_x,

View File

@@ -45,7 +45,7 @@ int main(void)
system_delay_init(); system_delay_init();
debug_init(); debug_init();
by_frame_init(); by_frame_init();
for (int i = 0; i < 3; i++) { for (int i = 0; i < 6; i++) {
by_frame_send(&send_reset); by_frame_send(&send_reset);
} }
encoder_quad_init(TIM3_ENCOEDER, TIM3_ENCOEDER_MAP3_CH1_C6, TIM3_ENCOEDER_MAP3_CH2_C7); encoder_quad_init(TIM3_ENCOEDER, TIM3_ENCOEDER_MAP3_CH1_C6, TIM3_ENCOEDER_MAP3_CH2_C7);

View File

@@ -130,6 +130,8 @@ void Page_Init(void)
PAGE_REG(page_param_pid2); PAGE_REG(page_param_pid2);
PAGE_REG(page_param_pid3); PAGE_REG(page_param_pid3);
PAGE_REG(page_dparam); PAGE_REG(page_dparam);
PAGE_REG(page_gocar);
PAGE_REG(page_stopcar);
Page_Shift(page_menu); Page_Shift(page_menu);
pagelist[now_page].SetupCallback(); // 先构建一遍 pagelist[now_page].SetupCallback(); // 先构建一遍

View File

@@ -25,6 +25,9 @@ enum PageID {
page_param_pid2, page_param_pid2,
page_param_pid3, page_param_pid3,
page_dparam, page_dparam,
page_stopcar,
page_gocar,
// page_argv, // page_argv,
// page_sys, // page_sys,
// page_run, // page_run,

View File

@@ -2,7 +2,7 @@
#include "page_ui_widget.h" #include "page_ui_widget.h"
#include "jj_motion.h" #include "jj_motion.h"
#include "page.h" #include "page.h"
#include"jj_voltage.h" #include "jj_voltage.h"
#include <math.h> #include <math.h>
#define LINE_HEAD 0 #define LINE_HEAD 0
@@ -61,9 +61,11 @@ static void Loop()
ips200_show_string(0, 160, "outpos"); ips200_show_string(0, 160, "outpos");
ips200_show_float(80, 160, out_pos, 4, 1); ips200_show_float(80, 160, out_pos, 4, 1);
ips200_show_string(0, 180, "vol"); ips200_show_string(0, 180, "vol");
ips200_show_float(80, 180, (float)now_vol, 4,2); ips200_show_float(80, 180, (float)now_vol, 4, 2);
ips200_show_string(0, 200, "setsp"); ips200_show_string(0, 200, "setsp");
ips200_show_float(80, 200, set_speed, 4,2); ips200_show_float(80, 200, set_speed, 4, 2);
ips200_show_string(0, 220, "dis");
ips200_show_float(80, 220, start_dis, 4, 2);
ips200_show_string(180, 0, "ls"); ips200_show_string(180, 0, "ls");
ips200_show_float(220, 0, pwm_duty_ls, 4, 1); ips200_show_float(220, 0, pwm_duty_ls, 4, 1);

120
app/page/page_gocar.c Normal file
View File

@@ -0,0 +1,120 @@
#include "zf_common_headfile.h"
#include "page_ui_widget.h"
#include "page.h"
#include "by_frame.h"
#include "jj_blueteeth.h"
#include "jj_motion.h"
#define LINE_HEAD 1
#define LINE_END 6
static char Text[] = "gocar";
static int8_t Curser = LINE_HEAD; // 定义光标位置
static int8_t Curser_Last = LINE_HEAD; // 定义光标位置
static int8_t last_go = 0;
static int8_t last_cnt = 0;
static int8_t last_fly = 0;
/***************************************************************************************
*
* 以下为页面模板函数
*
***************************************************************************************/
/**
* @brief 页面初始化事件
* @param 无
* @retval 无
*/
static void Setup()
{
ips200_clear();
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
ips200_show_string(10, 200, "go_flag:");
ips200_show_int(80, 200, go_cnt, 1);
ips200_show_string(10, 180, "ru_flag:");
ips200_show_int(80, 180, bt_run_flag, 1);
ips200_show_string(10, 160, "fl_flag:");
ips200_show_int(80, 160, bt_fly_flag, 1);
ips200_show_string(10, 18, "fan_test");
ips200_show_string(10, 2 * 18, "run");
}
/**
* @brief 页面退出事件
* @param 无
* @retval 无
*/
static void Exit()
{
}
/**
* @brief 页面循环执行的内容
* @param 无
* @retval 无
*/
static void Loop()
{
if (last_cnt != go_cnt) {
ips200_show_int(80, 200, go_cnt, 1);
}
last_cnt = go_cnt;
if (last_go != bt_run_flag) {
ips200_show_int(80, 180, bt_run_flag, 1);
}
last_go = bt_run_flag;
if (last_fly != bt_fly_flag) {
ips200_show_int(80, 160, bt_fly_flag, 1);
}
last_fly = bt_fly_flag;
}
/**
* @brief 页面事件
* @param btn:发出事件的按键
* @param event:事件编号
* @retval 无
*/
static void Event(page_event event)
{
Curser_Last = Curser;
if (page_event_forward == event) {
Curser--; // 光标上移
} else if (page_event_backward == event) {
Curser++; // 光标下移
} else if (page_event_press_short == event) {
if (go_cnt == 1 && Curser == 1) {
go_cnt = 0; // 起步拖动失败。重新开始
} else if (go_cnt == 0 && Curser == 1) {
go_cnt = 1;
bt_fly_flag = 1;
}
if (go_cnt == 1 && Curser == 2) {
go_cnt = 2;
}
} else if (page_event_press_long == event) {
Page_Shift(page_menu);
}
if (Curser < LINE_HEAD) {
Curser = LINE_END;
} else if (Curser > LINE_END) {
Curser = LINE_HEAD;
}
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
}
/**
* @brief 页面注册函数
*
* @param pageID
*/
void PageRegister_page_gocar(unsigned char pageID)
{
Page_Register(pageID, Text, Setup, Loop, Exit, Event);
}

View File

@@ -6,15 +6,13 @@
#include "jj_motion.h" #include "jj_motion.h"
#define LINE_HEAD 1 #define LINE_HEAD 1
#define LINE_END 5 #define LINE_END 7
static char Text[] = "Menu"; static char Text[] = "Menu";
static int8_t Curser = LINE_HEAD; // 定义光标位置 static int8_t Curser = LINE_HEAD; // 定义光标位置
static int8_t Curser_Last = LINE_HEAD; // 定义光标位置 static int8_t Curser_Last = LINE_HEAD; // 定义光标位置
uint32_t cnt = 0;
uint32_t reset[3];
static void Print_Menu_p(void); static void Print_Menu_p(void);
/*************************************************************************************** /***************************************************************************************
* *
@@ -29,10 +27,10 @@ static void Print_Menu_p(void);
*/ */
static void Setup() static void Setup()
{ {
ips200_clear(); ips200_clear();
Print_Menu_p(); Print_Menu_p();
Print_Curser(Curser, Curser_Last, RGB565_PURPLE); Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
reset[0] = 0x01;
} }
/** /**
@@ -51,15 +49,6 @@ static void Exit()
*/ */
static void Loop() static void Loop()
{ {
ips200_show_string(0, 200, "go_flag:");
ips200_show_int(180, 200, go_flag, 2);
if (go_flag == 1) {
bt_fly_flag = 1;
} else if (go_flag == 2) {
system_delay_ms(2000);
bt_run_flag = 1;
}
} }
/** /**
@@ -81,18 +70,6 @@ static void Event(page_event event)
Page_Shift(Curser); // 切换到光标选中的页面 Page_Shift(Curser); // 切换到光标选中的页面
} }
} else if (page_event_press_long == event) { } else if (page_event_press_long == event) {
if (go_flag == 0) {
go_flag = 1;
} else if (go_flag == 1) {
go_flag = 2;
}
// uint32_t temp = 0x5c;
// for (int i = 0; i < 3; i++) {
// by_frame_send(&temp);
// }
// ips200_clear();
} }
if (Curser < LINE_HEAD) { if (Curser < LINE_HEAD) {

View File

@@ -5,7 +5,7 @@
#include <math.h> #include <math.h>
#define LINE_HEAD 1 #define LINE_HEAD 1
#define LINE_END DATA_IN_FLASH_NUM - Page4_head #define LINE_END Page5_head - Page4_head
#define Strat_param Page4_head #define Strat_param Page4_head
static char Text[] = "barr_pid"; static char Text[] = "barr_pid";
static int event_flag = 0; static int event_flag = 0;

137
app/page/page_stopcar.c Normal file
View File

@@ -0,0 +1,137 @@
#include "jj_param.h"
#include "page_ui_widget.h"
#include "jj_motion.h"
#include "page.h"
#include <math.h>
#define LINE_HEAD 1
#define LINE_END DATA_IN_FLASH_NUM - Page5_head
#define Strat_param Page5_head
static char Text[] = "stop_sw";
static int event_flag = 0;
static int index_power = 0;
static int8_t Curser = LINE_HEAD; // 定义光标位置
static int8_t Curser_Last = LINE_HEAD; // 定义光标位置
static void jj_param_show();
/***************************************************************************************
*
* 以下为页面模板函数
*
***************************************************************************************/
/**
* @brief 页面初始化事件
* @param 无
* @retval 无
*/
static void Setup()
{
ips200_clear();
ips200_show_string(0, 2,"barrir");
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
for (int16 i = 0; i < LINE_END; i++) {
ips200_show_string(0, i * 18 + 20, Param_Data[i +Strat_param ].text);
if (Param_Data[i + Strat_param].type == EINT32)
ips200_show_int(50, i * 18 + 20, *((int32 *)(Param_Data[i + Strat_param].p_data)), 5);
else if (Param_Data[i + Strat_param].type == EFLOAT)
ips200_show_float(50, i * 18 + 20, *((float *)(Param_Data[i + Strat_param].p_data)), 4, 5);
}
ips200_show_int(100, 2, index_power, 5);
}
/**
* @brief 页面退出事件
* @param 无
* @retval 无
*/
static void Exit()
{
}
/**
* @brief 页面循环执行的内容
* @param 无
* @retval 无
*/
static void Loop()
{
}
/**
* @brief 页面事件
* @param btn:发出事件的按键
* @param event:事件编号
* @retval 无
*/
static void Event(page_event event)
{
if (0 == event_flag) {
Curser_Last = Curser;
if (page_event_forward == event) {
Curser--; // 光标上移
} else if (page_event_backward == event) {
Curser++; // 光标下移
} else if (page_event_press_short == event) {
event_flag = 1; // 选中参数
Print_Curser(Curser, Curser_Last, RGB565_RED);
return;
} else if (page_event_press_long == event) {
jj_param_write();
sport_pid_init();
Page_Shift(page_menu);
return;
}
if (Curser < LINE_HEAD) {
Curser = LINE_END;
} else if (Curser > LINE_END) {
Curser = LINE_HEAD;
}
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
} else if (1 == event_flag) {
if (page_event_forward == event) {
if (Param_Data[Curser + Strat_param-1].type == EFLOAT) {
*((float *)(Param_Data[Curser + Strat_param-1].p_data)) += powf(10.0f, (float)index_power);
} else if (Param_Data[Curser + Strat_param-1].type == EINT32) {
*((int32 *)(Param_Data[Curser + Strat_param-1].p_data)) += 1;
} else if (Param_Data[Curser + Strat_param-1].type == EUINT32) {
*((uint32 *)(Param_Data[Curser + Strat_param-1].p_data)) += 1;
}
} else if (page_event_backward == event) {
if (Param_Data[Curser + Strat_param-1].type == EFLOAT) {
*((float *)(Param_Data[Curser + Strat_param-1].p_data)) -= powf(10.0f, (float)index_power);
} else if (Param_Data[Curser + Strat_param-1].type == EINT32) {
*((int32 *)(Param_Data[Curser + Strat_param-1].p_data)) -= 1;
} else if (Param_Data[Curser + Strat_param-1].type == EUINT32) {
*((uint32 *)(Param_Data[Curser + Strat_param-1].p_data)) -= 1;
}
} else if (page_event_press_short == event) {
index_power++;
if (index_power > 2) {
index_power = -2;
}
ips200_show_int(100, 2, index_power, 5);
} else if (page_event_press_long == event) {
event_flag = 0;
Print_Curser(Curser, Curser_Last, RGB565_PURPLE);
}
jj_param_show();
}
}
static void jj_param_show()
{
if (EINT32 == Param_Data[Curser + Strat_param-1].type)
ips200_show_int(50, Curser * 18 + 2, *((int32 *)(Param_Data[Curser + Strat_param-1].p_data)), 5);
else if (EUINT32 == Param_Data[Curser + Strat_param-1].type)
ips200_show_uint(50, Curser * 18 + 2, *((int32 *)(Param_Data[Curser + Strat_param-1].p_data)), 5);
else if (EFLOAT == Param_Data[Curser + Strat_param-1].type)
ips200_show_float(50, Curser * 18 + 2, *((float *)(Param_Data[Curser + Strat_param-1].p_data)), 4, 5);
}
/**
* @brief 页面注册函数
*
* @param pageID
*/
void PageRegister_page_stopcar(unsigned char pageID)
{
Page_Register(pageID, Text, Setup, Loop, Exit, Event);
}