From 310754a3de9ee12cbabc4b46ab2c144c62fa8d7e Mon Sep 17 00:00:00 2001
From: zhyinch <zhyinch@gmail.com>
Date: 星期六, 13 八月 2022 21:27:35 +0800
Subject: [PATCH] V2.53 增加震动状态上传和震动实时响应功能
---
Src/application/dw_app.c | 11 +++++++++--
1 files changed, 9 insertions(+), 2 deletions(-)
diff --git a/Src/application/dw_app.c b/Src/application/dw_app.c
index acfa1ce..0eb9c2a 100644
--- a/Src/application/dw_app.c
+++ b/Src/application/dw_app.c
@@ -796,6 +796,7 @@
//HexToAsciiSendUDP(usart_send,27+8*nearbase_num);
}
uint8_t pack_length = 0,pack_index = 0,pack_msgtype = 0;
+uint8_t motor_flag;
void NearPoll(void)
{
@@ -820,9 +821,15 @@
recbase_num=0;
// motor_state=0;
+ if(motor_state!=0&&motor_state!=3)
+ {
+ motor_flag = 1;
+ }else{
+ motor_flag = 0;
+ }
tx_near_msg[BATTARY_IDX] = bat_percent;
- tx_near_msg[BUTTON_IDX] = userkey_state|stationary_flag<<1|gotosleep_flag<<2;
+ tx_near_msg[BUTTON_IDX] = userkey_state|stationary_flag<<1|gotosleep_flag<<2|motor_flag<<5;
tx_near_msg[SEQUENCE_IDX] = frame_seq_nb;
tx_near_msg[SEQUENCEH_IDX] = (frame_seq_nb++)>>8;
tx_near_msg[NEARBASENUM_INDEX] = nearbase_num;
@@ -1063,7 +1070,7 @@
{
if( pack_index == MOTOR_ONTIME_INDEX)
{
- if(motor_keeptime==0)
+ // if(motor_keeptime==0)
motor_keeptime = rec_remotepara[3];
}else{
if(pack_index<200)
--
Gitblit v1.9.3