dispatch_device_base.h 8.0 KB

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