From 25777013517d1bd398a98504826a417236706af2 Mon Sep 17 00:00:00 2001 From: yy1717 <fctom1215@outlook.com> Date: 星期二, 24 三月 2020 19:01:29 +0800 Subject: [PATCH] 车辆信号完善,路边停车完善。 --- lib/src/main/cpp/test_common/car_sensor.cpp | 103 +++++++++++++++++++++++++++++++++++++++++++++++++-- 1 files changed, 99 insertions(+), 4 deletions(-) diff --git a/lib/src/main/cpp/test_common/car_sensor.cpp b/lib/src/main/cpp/test_common/car_sensor.cpp index a7a4692..ea4c242 100644 --- a/lib/src/main/cpp/test_common/car_sensor.cpp +++ b/lib/src/main/cpp/test_common/car_sensor.cpp @@ -23,7 +23,6 @@ SENSOR_RIGHT_TURN_SIGNAL, SENSOR_HANDBREAK, SENSOR_BREAK, - SENSOR_CLEARANCE_LIGHT, SENSOR_DIPPED_BEAM_LIGHT, SENSOR_MAIN_BEAM_LIGHT, SENSOR_DOOR, @@ -35,6 +34,13 @@ SENSOR_SHIFT_5, SENSOR_SHIFT_R, SENSOR_ENGINE_START, + SENSOR_BREAK2, + SENSOR_SURROUND_CAR_1, + SENSOR_SURROUND_CAR_2, + SENSOR_SURROUND_CAR_3, + SENSOR_SURROUND_CAR_4, + SENSOR_FOG_LIGHT, + SENSOR_CLEARANCE_LIGHT, SENSOR_ENGINE_RPM, SENSOR_SPEED }; @@ -137,8 +143,6 @@ } } } - - } int ReadCarStatus(uint16_t id) @@ -194,6 +198,8 @@ static void SensorChanged(int id, int value) { + DEBUG("鐘舵�佹敼鍙� %d = %d", id, value); + switch (id) { case SENSOR_LEFT_TURN_SIGNAL: { left_turn_signal = value; @@ -220,6 +226,14 @@ } else { AppTimer_add(ConfirmTurnSigalLater, 200, RIGHT_TURN_LIGHT); } + } + break; + } + case SENSOR_FOG_LIGHT: { + if (value == 0) { + WriteCarStatus(FOG_LAMP, OFF_LIGHT); + } else { + WriteCarStatus(FOG_LAMP, FOG_LIGHT); } break; } @@ -250,7 +264,7 @@ WriteCarStatus(FLASH_BEAM_LAMP, FLASH_BEAM_LIGHT); AppTimer_delete(flashBeamLightClose); - AppTimer_add(flashBeamLightClose, D_SEC(5)); + AppTimer_add(flashBeamLightClose, D_SEC(2)); } AppTimer_delete(confirmFlashBeamLightLater); @@ -266,6 +280,87 @@ break; } case SENSOR_ENGINE_START: { + if (value == 0) { + WriteCarStatus(ENGINE_START, ENGINE_START_INACTIVE); + } else { + WriteCarStatus(ENGINE_START, ENGINE_START_ACTIVE); + } + break; + } + case SENSOR_BREAK: { + if (value == 0) { + WriteCarStatus(BREAK, BREAK_INACTIVE); + } else { + WriteCarStatus(BREAK, BREAK_ACTIVE); + } + break; + } + case SENSOR_BREAK2: { + if (value == 0) { + WriteCarStatus(SECOND_BREAK, BREAK_INACTIVE); + } else { + WriteCarStatus(SECOND_BREAK, BREAK_ACTIVE); + } + break; + } + case SENSOR_HANDBREAK: { + if (value == 0) { + WriteCarStatus(HAND_BREAK, BREAK_INACTIVE); + } else { + WriteCarStatus(HAND_BREAK, BREAK_ACTIVE); + } + break; + } + case SENSOR_DOOR: { + if (value == 0) { + WriteCarStatus(DOOR, DOOR_OPEN); + } else { + WriteCarStatus(DOOR, DOOR_CLOSE); + } + break; + } + case SENSOR_SURROUND_CAR_1: { + if (value == 0) { + WriteCarStatus(SURROUND_CAR_1, SURROUND_CAR_INACTIVE); + } else { + WriteCarStatus(SURROUND_CAR_1, SURROUND_CAR_ACTIVE); + } + break; + } + case SENSOR_SURROUND_CAR_2: { + if (value == 0) { + WriteCarStatus(SURROUND_CAR_2, SURROUND_CAR_INACTIVE); + } else { + WriteCarStatus(SURROUND_CAR_2, SURROUND_CAR_ACTIVE); + } + break; + } + case SENSOR_SURROUND_CAR_3: { + if (value == 0) { + WriteCarStatus(SURROUND_CAR_3, SURROUND_CAR_INACTIVE); + } else { + WriteCarStatus(SURROUND_CAR_3, SURROUND_CAR_ACTIVE); + } + break; + } + case SENSOR_SURROUND_CAR_4: { + if (value == 0) { + WriteCarStatus(SURROUND_CAR_4, SURROUND_CAR_INACTIVE); + } else { + WriteCarStatus(SURROUND_CAR_4, SURROUND_CAR_ACTIVE); + } + break; + } + case SENSOR_SHIFT_N: + case SENSOR_SHIFT_1: + case SENSOR_SHIFT_2: + case SENSOR_SHIFT_3: + case SENSOR_SHIFT_4: + case SENSOR_SHIFT_5: + case SENSOR_SHIFT_R: { + if (value != 0) { + WriteCarStatus(GEAR, id - SENSOR_SHIFT_N + GEAR_N); + } break; } default: -- Gitblit v1.8.0