dispatch_device_base.h 8.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232
  1. //
  2. // Created by huli on 2021/3/3.
  3. //
  4. #ifndef NNXX_TESTS_DISPATCH_DEVICE_BASE_H
  5. #define NNXX_TESTS_DISPATCH_DEVICE_BASE_H
  6. #include "../error_code/error_code.h"
  7. #include <glog/logging.h>
  8. #include <thread>
  9. #include <mutex>
  10. #include "../tool/thread_condition.h"
  11. #include "../tool/common_data.h"
  12. #include "../tool/time_tool.h"
  13. #include "../task/task_base.h"
  14. #include "../dispatch/dispatch_communication.h"
  15. #include "../dispatch/dispatch_coordinates.h"
  16. //调度设备的基类.
  17. class Dispatch_device_base
  18. {
  19. public:
  20. //设备底层通信延时5000ms
  21. #define COMMUNICATION_OVER_TIME_MS 5000
  22. //设备状态,这个类的总状态,这里指工作任务流程
  23. enum Dispatch_device_status
  24. {
  25. DISPATCH_DEVICE_UNKNOW = 0, //未知
  26. DISPATCH_DEVICE_READY = 1, //准备,待机
  27. DISPATCH_DEVICE_BUSY = 2, //工作正忙
  28. DISPATCH_DEVICE_ONE_LEVEL_OVER = 3, //一级工作完成,
  29. DISPATCH_DEVICE_ONE_LEVEL_WORK = 4, //一级工作状态, 就是普通的移动任务
  30. DISPATCH_DEVICE_TWO_LEVEL_OVER = 5, //一级工作完成,
  31. DISPATCH_DEVICE_TWO_LEVEL_WORK = 6, //二级工作状态, 就是紧急避让, 插队任务(会在执行一级任务的过程中, 插队并优先执行二级任务)
  32. DISPATCH_DEVICE_THREE_LEVEL_OVER = 7, //一级工作完成,
  33. DISPATCH_DEVICE_THREE_LEVEL_WORK = 8, //三级工作任务, 就是锁定硬件资源, 不让插队, (除非急停或者取消任务)
  34. DISPATCH_DEVICE_FAULT = 100, //故障
  35. DISPATCH_DEVICE_DISCONNECT = 101, //通信故障
  36. };
  37. //调度任务的等级
  38. enum Dispatch_task_level
  39. {
  40. // DISPATCH_TASK_UNKNOW_LEVEL = 0, //无效任务
  41. DISPATCH_TASK_ONE_LEVEL = 1, //一级任务
  42. DISPATCH_TASK_TWO_LEVEL = 2, //二级任务
  43. DISPATCH_TASK_THREE_LEVEL = 3, //三级任务
  44. };
  45. //抓车的夹杆
  46. enum Clamp_motion
  47. {
  48. E_CLAMP_NO_ACTION = 0, //无动作.
  49. E_CLAMP_TIGHT = 1, //夹紧夹杆
  50. E_CLAMP_LOOSE = 2, //松开夹杆
  51. };
  52. //中跑车和平层轨道的对接
  53. enum Joint_motion
  54. {
  55. E_JOINT_NO_ACTION = 0, //无动作.
  56. E_JOINT_HOLD_OUT = 1, //伸出对接,之后中跑车可以x轴移动,电梯不能Z轴移动
  57. E_JOINT_TAKE_BACK = 2, //收回对接,之后中跑车固定在电梯上不能X轴移动,电梯可以Z轴移动
  58. };
  59. //小跑车的位置,是否在中跑车上面
  60. enum Small_sports_car_motion
  61. {
  62. E_SMALL_SPORTS_NO_ACTION = 0, //无动作.
  63. E_SMALL_SPORTS_CAR_GET_AWAY = 1, //小跑车离开中跑车
  64. E_SMALL_SPORTS_CAR_GET_BACK = 2, //小跑车返回中跑车
  65. };
  66. //指令完成状态, 设备答复指令, 返回任务完成的情况
  67. enum Respons_status
  68. {
  69. RESPONS_WORKING = 0, //任务进行中
  70. RESPONS_OVER = 1, //任务完成
  71. RESPONS_MINOR_ERROR = 100, //一般故障, 可恢复
  72. RESPONS_CRITICAL_ERROR = 101, //致命故障,不可恢复
  73. };
  74. //设备的硬件设备状态
  75. enum Hardware_device_status
  76. {
  77. HARDWARE_DEVICE_UNKNOWN = 0, //设备未知
  78. HARDWARE_DEVICE_READY = 1, //设备空闲(可以接受新的指令任务)
  79. HARDWARE_DEVICE_WORKING = 2, //设备工作中
  80. HARDWARE_DEVICE_EMERGENCY_STOP = 3, //设备急停
  81. HARDWARE_DEVICE_UNSAFETY = 4, //设备不安全(暂时不考虑是否处于安全位置)
  82. HARDWARE_DEVICE_COLLISION = 5, //设备发生碰撞
  83. HARDWARE_DEVICE_FAULT = 6, //设备故障
  84. };
  85. //设备的负载状态, 小跑车上面是否有车.
  86. enum Load_status
  87. {
  88. LOAD_UNKNOWN = 0, //负载未知
  89. HAVE_CAR = 1, //有车
  90. NO_CAR = 2, //没车
  91. };
  92. //7号出口 转台方向
  93. enum Turntable_direction
  94. {
  95. TURNTABLE_DIRECTION_UNKNOWN = 0, //方向未知,
  96. TURNTABLE_DIRECTION_INSIDE = 1, //方向朝里,对接内门的小跑车
  97. TURNTABLE_DIRECTION_OUTSIDE = 2, //没车朝外,对接外门的出口
  98. };
  99. //出入口 门的开关状态
  100. enum Door_motion
  101. {
  102. DOOR_UNKNOWN = 0, //门的开关状态 未知, 或者工作到一半,正在工作中.
  103. DOOR_OPEN = 1, //开门
  104. DOOR_CLOSE = 2, //关门
  105. DOOR_ERROR = 3, //
  106. };
  107. //边界判断,是否超界
  108. enum Overstep_the_boundary
  109. {
  110. BOUNDARY_NORMAL = 0, //边界 正常
  111. BOUNDARY_OVERSTEP = 1, //超界
  112. };
  113. //机器手朝向角度
  114. #define CATCHER_DIRECTION_POSITIVE_MIN 70
  115. #define CATCHER_DIRECTION_POSITIVE_CENTER 90
  116. #define CATCHER_DIRECTION_POSITIVE_MAX 110
  117. #define CATCHER_DIRECTION_NEGATIVE_MIN 250
  118. #define CATCHER_DIRECTION_NEGATIVE_CENTER 270
  119. #define CATCHER_DIRECTION_NEGATIVE_MAX 290
  120. //机器手朝向
  121. enum Catcher_direction
  122. {
  123. CATCHER_DIRECTION_UNKNOW = 0, //
  124. CATCHER_DIRECTION_POSITIVE = 1, //朝正, 70~110度
  125. CATCHER_DIRECTION_NEGATIVE = 2, //朝反, 250~290度
  126. };
  127. public:
  128. Dispatch_device_base();
  129. Dispatch_device_base(const Dispatch_device_base& other)= default;
  130. Dispatch_device_base& operator =(const Dispatch_device_base& other)= default;
  131. ~Dispatch_device_base();
  132. public://API functions
  133. //设备 初始化
  134. virtual Error_manager dispatch_device_base_init(int device_id);
  135. //设备 反初始化
  136. virtual Error_manager dispatch_device_base_uninit();
  137. //执行任务//注意了, 调度任务允许同时接受多个任务
  138. virtual Error_manager execute_task(std::shared_ptr<Task_Base> p_task, Dispatch_task_level dispatch_task_level);
  139. //检查任务类型, 子类必须重载, 用来检查输入的任务是否为子类所需的.
  140. virtual Error_manager check_task_type(std::shared_ptr<Task_Base> p_task);
  141. //判断能否执行任务
  142. virtual Error_manager check_task_level(Dispatch_task_level dispatch_task_level);
  143. //签收任务
  144. virtual Error_manager sign_for_task(std::shared_ptr<Task_Base> p_task, Dispatch_task_level dispatch_task_level);
  145. //检查状态,是否正常运行. (工作状态 和 是否能接受对应的任务无关)
  146. virtual Error_manager check_status();
  147. //判断是否为待机,如果已经准备好,则可以执行任务。
  148. virtual bool is_ready();
  149. //结束任务单,里面会根据任务的故障等级修正 任务单的状态
  150. virtual Error_manager end_task(std::shared_ptr<Task_Base> p_task);
  151. //取消任务单,由发送方提前取消任务单
  152. virtual Error_manager cancel_task(std::shared_ptr<Task_Base> p_task, Dispatch_task_level dispatch_task_level);
  153. public://get or set member variable
  154. Dispatch_device_status get_dispatch_device_status();
  155. //获取硬件设备的状态, 必须子类继承
  156. virtual Hardware_device_status get_actual_device_status();
  157. int get_device_id();
  158. protected://member functions
  159. //执行外界任务的执行函数
  160. void execute_thread_fun();
  161. //执行线程工作函数, 正在执行任务单.
  162. virtual Error_manager execute_thread_working(std::shared_ptr<Task_Base> p_task, Dispatch_device_status & carrier_status);
  163. //执行线程工作函数, 已经完成任务单. 等待新的指令
  164. virtual Error_manager execute_thread_over(std::shared_ptr<Task_Base> p_task, Dispatch_device_status & carrier_status);
  165. //把任务单写入到内存中, 子类必须重载
  166. virtual Error_manager write_task_to_memory(std::shared_ptr<Task_Base> p_task);
  167. //更新设备底层通信数据, 子类必须重载
  168. virtual Error_manager update_device_communication();
  169. //从内存中读数据到任务单, 子类必须重载
  170. virtual Error_manager check_and_read_memory_to_task(std::shared_ptr<Task_Base> p_task);
  171. //取消下发的指令, 子类必须重载, 用来向下发送命令取消任务.
  172. virtual Error_manager cancel_command();
  173. protected://member variable
  174. std::atomic<Dispatch_device_status> m_dispatch_device_status; //设备总状态, 控制任务流程(长流程)
  175. int m_device_id; //设备id,
  176. std::mutex m_lock; //锁
  177. //任务执行线程
  178. std::thread* mp_execute_thread; //执行的线程指针,内存由本类管理
  179. Thread_condition m_execute_condition; //执行的条件变量
  180. std::shared_ptr<Task_Base> mp_device_one_level_task; //设备的普通任务, (一般移动和等待指令, 允许被打断)
  181. std::shared_ptr<Task_Base> mp_device_two_level_task; //设备的优先任务, (紧急避让和插队指令, 允许打断普通任务)
  182. std::shared_ptr<Task_Base> mp_device_three_level_task; //设备的核心任务, (锁定位置进行抓车和放车, 最高任务, 不允许打断和被打断)
  183. //task任务的流程由Dispatch_process来管理
  184. private:
  185. };
  186. #endif //NNXX_TESTS_DISPATCH_DEVICE_BASE_H