dispatch_device_base.h 8.1 KB

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