123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253 |
- #pragma once
- #include <stdint.h>
- #include <mutex>
- #include <thread>
- #include "comm.h"
- struct FeedbackData
- {
- struct ControlState
- {
- uint8_t main_start = 0;
- uint8_t horn = 0;
- uint8_t front_light = 0;
- uint8_t rear_light = 0;
- uint8_t front_rear_light = 0;
- uint8_t enable = 0;
- uint8_t brake_release = 0;
- uint8_t connect = 0;
- uint8_t connect_start = 0;
- uint8_t pilot_valve = 0;
- uint8_t em_stop = 0;
- uint8_t em_stop_inverted = 0;
- int8_t shovel_loader = 0;
- int8_t shovel_arm = 0;
- int8_t direction = 0;
- int8_t moverment = 0;
- };
- struct Feedback
- {
- uint8_t water_temp_alarm = 0;
- uint8_t oil_pressure_low_alarm = 0;
- uint8_t air_filter_alarm = 0;
- uint8_t left_oil_filter_alarm = 0;
- uint8_t right_oil_filter_alarm = 0;
- uint8_t oil_loop_filter_alarm = 0;
- uint8_t hydr_pressure_low_alarm = 0;
- int32_t engine_rpm = 0;
- uint8_t oil_pressure = 0;
- uint8_t water_temperature = 0;
- int32_t left_MA_pressure = 0;
- int32_t left_MB_pressure = 0;
- int32_t right_MA_pressure = 0;
- int32_t right_MB_pressure = 0;
- int32_t pump_pressure = 0;
- int32_t left_motor_rpm = 0;
- int32_t right_motor_rpm = 0;
- uint8_t hydr_oil_height = 0;
- uint8_t disel_oil_height = 0;
- int32_t up_time = 0;
- uint8_t votage = 0;
- };
- ControlState controlStat;
- Feedback feedback;
- };
-
- typedef struct _CAN_OBJ{
- uint32_t ID;
- uint8_t NodeId;
- uint32_t TimeStamp;
- uint8_t TimeFlag;
- uint8_t SendType;
- uint8_t RemoteFlag;
- uint8_t ExternFlag;
- uint8_t DataLen;
- uint8_t Data[8];
- }CAN_OBJ;
- class FeedbackStat {
- public:
- FeedbackStat();
- ~FeedbackStat();
-
- FeedbackData GetFeedback();
- FeedbackData feedBackState_;
-
- void receiveCanData();
- void dealCanData(CAN_OBJ candata);
- static volatile int32_t num_of_rec;
- static CAN_OBJ can_receive_struct[100];
- void dealPDO200Status(CAN_OBJ candata);
- void dealPDO300Status(CAN_OBJ candata);
- void dealPDO400Status(CAN_OBJ candata);
- void dealPDO500Status(CAN_OBJ candata);
- static volatile FeedbackData feedBackData;
- private:
- std::mutex feedback_state_mutex_;
- };
|