| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109 |
- #include "rabbitmq_communication.h"
- RabbitmqCommunicationTof3D::RabbitmqCommunicationTof3D() = default;
- RabbitmqCommunicationTof3D::~RabbitmqCommunicationTof3D() = default;
- //检查消息是否有效, 主要检查消息类型和接受者, 判断这条消息是不是给我的.
- Error_manager RabbitmqCommunicationTof3D::check_msg(Rabbitmq_message *p_msg) {
- return {SUCCESS, NORMAL, "Don't check any message."};
- }
- //检查执行者的状态, 判断能否处理这条消息, 需要子类重载
- Error_manager RabbitmqCommunicationTof3D::check_executer(Rabbitmq_message *p_msg) {
- return {SUCCESS, NORMAL, "Don't check any message."};
- }
- //处理消息, 需要子类重载
- Error_manager RabbitmqCommunicationTof3D::execute_msg(Rabbitmq_message *p_msg) {
- Error_manager ret;
- // LOG(INFO) << p_msg->m_routing_key;
- // if (p_msg->m_routing_key == "dispatch_31_statu_port") {
- // dispatch_node_statu t_dispatch_node_statu;
- // if(google::protobuf::TextFormat::ParseFromString(p_msg->m_message_buf, &t_dispatch_node_statu))
- // {
- // LOG(INFO) << t_dispatch_node_statu.DebugString();
- // // TODO:开关门控制算法流程
- //// usleep(5 * 1000 * 1000);
- //// DetectManager::iter()->Stop();
- //// DeviceTof3D::iter()->Stop();
- ////
- //// usleep(5 * 1000 * 1000);
- //// DeviceTof3D::iter()->Continue();
- //// DetectManager::iter()->Continue();
- // }
- // }
- //
- // //终端点击存车时, 发送存车表单给检查节点, 这里顺便发送给感测节点.
- // if (p_msg->m_routing_key == "user_park_command_request_port") {
- // park_table t_park_table_msg; //存车表单
- // if(google::protobuf::TextFormat::ParseFromString(p_msg->m_message_buf, &t_park_table_msg))
- // {
- // LOG(INFO) << t_park_table_msg.DebugString();
- // // TODO:从算法取数据保存
- // }
- // }
- return ret;
- }
- //处理消息, 需要子类重载
- Error_manager RabbitmqCommunicationTof3D::execute_time_consume_msg(Rabbitmq_message *p_msg) {
- return {};
- }
- //定时封装发送消息, 一般为心跳和状态信息, 需要子类重载
- Error_manager RabbitmqCommunicationTof3D::auto_encapsulate_status() {
- static int heart = 0;
- if (++heart > 999) {
- heart = 0;
- }
- measure_buffer rabbit_measure_info;
- DetectManager::DetectResult detect_measure_info;
- // 设备状态
- if (DeviceTof3D::iter()->getDeviceStatus() != SUCCESS) {
- rabbit_measure_info.mutable_measure_info_to_plc_forward()->set_ground_status(MeasureStatu::Lidar_Disconnect);
- }
- MeasureStatu measure_status = DetectManager::iter()->getMeasureResult(detect_measure_info);
- if (measure_status != MeasureStatu::Measure_OK) {
- if (measure_status == MeasureStatu::Measure_Border) {
- rabbit_measure_info.mutable_measure_info_to_plc_forward()->set_border_statu(Range_status::Range_back);
- }
- rabbit_measure_info.mutable_measure_info_to_plc_forward()->set_ground_status(measure_status);
- }
- // 超界判断
- JetStream::MeasureInfo info;
- m_boundary.transMeasureInfo(detect_measure_info, info);
- m_boundary.limit(info);
- // 保存grpc数据中间块
- TransitData::MeasureInfo grpc_measure_info;
- m_boundary.transMeasureInfo(info, grpc_measure_info);
- grpc_measure_info.error.append("heart: " + std::to_string(heart));
- grpc_measure_info.error.append(detect_measure_info.info());
- TransitData::get_instance_pointer()->setMeasureInfo(grpc_measure_info);
- // 发送rabbitmq消息
- m_boundary.transMeasureInfo(info, rabbit_measure_info);
- encapsulate_status_msg(rabbit_measure_info.DebugString(), 0);
- return {};
- }
- Error_manager RabbitmqCommunicationTof3D::rabbitmq_init_from_protobuf(std::string prototxt_path) {
- m_boundary.init(ETC_PATH PROJECT_NAME "/limit.prototxt") ?
- printf("boundary init success.\n") :
- printf("boundary init failed form %s.\n", ETC_PATH PROJECT_NAME "/limit.prototxt");
- return Rabbitmq_base::rabbitmq_init_from_protobuf(prototxt_path);
- }
|