Armer/HH3slave_STM32L476RGT6
3
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

取消关机状态

Browse Source
This commit is contained in:
chenxin
2025-06-24 09:24:52 +08:00
parent 15f16fc6bf
commit fd0fb4fe2f
2 changed files with 2 additions and 12 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
src/i2c_communication.cpp
View File

@ -61,6 +61,7 @@ void onReceiveEvent(int bytes) {
// 更新传感器状态和数据 // 更新传感器状态和数据
unsigned long last_gps_data_time = 0; unsigned long last_gps_data_time = 0;
static uint8_t last_receive_cnt = 0; static uint8_t last_receive_cnt = 0;
void update_sensor_data() { void update_sensor_data() {
//gps //gps
//if (millis() > 5000 && gps.charsProcessed() < 10 && digitalRead(GPS_POWER_PIN) == HIGH) //if (millis() > 5000 && gps.charsProcessed() < 10 && digitalRead(GPS_POWER_PIN) == HIGH)
@ -68,10 +69,6 @@ void update_sensor_data() {
sensor_data.gps_sta = 0x00; // 无设备 sensor_data.gps_sta = 0x00; // 无设备
sensor_data.gps_lat = 0.0f; sensor_data.gps_lat = 0.0f;
sensor_data.gps_lon = 0.0f; sensor_data.gps_lon = 0.0f;
} else if (digitalRead(GPS_POWER_PIN) == LOW){
sensor_data.gps_sta = 0x01; // 关机
sensor_data.gps_lat = 0.0f;
sensor_data.gps_lon = 0.0f;
} else if (!gps.location.isUpdated()) { } else if (!gps.location.isUpdated()) {
sensor_data.gps_sta = 0x02; // 未搜到信号 sensor_data.gps_sta = 0x02; // 未搜到信号
sensor_data.gps_lat = 0.0f; sensor_data.gps_lat = 0.0f;
@ -87,9 +84,6 @@ void update_sensor_data() {
if (receive_cnt == last_receive_cnt){ if (receive_cnt == last_receive_cnt){
sensor_data.height_sta = 0x00; // 无设备 sensor_data.height_sta = 0x00; // 无设备
sensor_data.height = 0.0f; sensor_data.height = 0.0f;
}else if (digitalRead(RANGING_POWER_PIN) == LOW){
sensor_data.height_sta = 0x01; // 关机
sensor_data.height = 0.0f;
}else { }else {
last_receive_cnt = receive_cnt; last_receive_cnt = receive_cnt;
sensor_data.height_sta = 0x03; // 有效高度，正常工作 sensor_data.height_sta = 0x03; // 有效高度，正常工作

4
src/main.cpp
View File

@ -37,10 +37,6 @@ void setup() {
gpsSerial.begin(GPS_BAUDRATE); //GPS gpsSerial.begin(GPS_BAUDRATE); //GPS
printSerial.begin(PRINT_BAUDRATE); // 调试输出串口（RX, TX） printSerial.begin(PRINT_BAUDRATE); // 调试输出串口（RX, TX）
power_init();
// digitalWrite(RANGING_POWER_PIN, HIGH);
// digitalWrite(GPS_POWER_PIN, HIGH);
printSerial.println("Initialized..."); printSerial.println("Initialized...");
} }