dispatch_device_base.cpp 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735
  1. //
  2. // Created by huli on 2021/3/3.
  3. //
  4. #include "dispatch_device_base.h"
  5. Dispatch_device_base::Dispatch_device_base()
  6. {
  7. m_dispatch_device_status = DISPATCH_DEVICE_UNKNOW;
  8. m_device_id = -1;
  9. mp_execute_thread = NULL;
  10. }
  11. Dispatch_device_base::~Dispatch_device_base()
  12. {
  13. dispatch_device_base_uninit();
  14. }
  15. //设备 初始化
  16. Error_manager Dispatch_device_base::dispatch_device_base_init(int device_id, int device_key)
  17. {
  18. m_device_id = device_id;
  19. m_device_key = device_key;
  20. // 线程默认开启
  21. m_execute_condition.reset(false, true, false);
  22. mp_execute_thread = new std::thread(&Dispatch_device_base::execute_thread_fun, this);
  23. m_dispatch_device_status = DISPATCH_DEVICE_READY;
  24. return Error_code::SUCCESS;
  25. }
  26. //设备 反初始化
  27. Error_manager Dispatch_device_base::dispatch_device_base_uninit()
  28. {
  29. if (mp_execute_thread)
  30. {
  31. m_execute_condition.kill_all();
  32. }
  33. if (mp_execute_thread)
  34. {
  35. mp_execute_thread->join();
  36. delete mp_execute_thread;
  37. mp_execute_thread = NULL;
  38. }
  39. m_dispatch_device_status = DISPATCH_DEVICE_UNKNOW;
  40. return Error_code::SUCCESS;
  41. }
  42. //执行任务
  43. Error_manager Dispatch_device_base::execute_task(std::shared_ptr<Task_Base> p_task, Dispatch_task_level dispatch_task_level)
  44. {
  45. LOG(INFO) << " ---Dispatch_device_base::execute_task ---"<< this;
  46. Error_manager t_error;
  47. Error_manager t_result;
  48. //检查指针
  49. if (p_task.get() == NULL) {
  50. return Error_manager(Error_code::POINTER_IS_NULL, Error_level::MINOR_ERROR,
  51. "Dispatch_device_base::execute_task failed, POINTER_IS_NULL");
  52. }
  53. //检查任务类型,
  54. t_error = check_task_type(p_task);
  55. if ( t_error != Error_code::SUCCESS )
  56. {
  57. return t_error;
  58. }
  59. //检查接收方能否接受任务
  60. t_error = check_task_level(dispatch_task_level);
  61. if ( t_error != SUCCESS )
  62. {
  63. t_result.compare_and_cover_error(t_error);
  64. }
  65. else
  66. {
  67. //接受任务,并将任务的状态改为TASK_SIGNED已签收
  68. t_error = sign_for_task(p_task, dispatch_task_level);
  69. if ( t_error != Error_code::SUCCESS )
  70. {
  71. return t_error;
  72. }
  73. //这里不用检查任务内容, 直接下发给底层设备
  74. //永远启动到三级任务工作状态.
  75. // 启动定位管理模块,的核心工作线程
  76. m_dispatch_device_status = DISPATCH_DEVICE_THREE_LEVEL_WORK;
  77. m_execute_condition.notify_all(true);
  78. //通知 thread_work 子线程启动。
  79. //只签收,并不一定进入工作状态, 在线程真正的执行的时候,才改为工作中, (执行线程可能会先处理更高优先级的任务单)
  80. }
  81. if ( t_result != Error_code::SUCCESS )
  82. {
  83. return t_result;
  84. }
  85. return Error_code::SUCCESS;
  86. }
  87. //检查任务类型, 子类必须重载, 用来检查输入的任务是否为子类所需的.
  88. Error_manager Dispatch_device_base::check_task_type(std::shared_ptr<Task_Base> p_task)
  89. {
  90. //检查任务类型,
  91. // if (p_task->get_task_type() != CARRIER_TASK)
  92. // {
  93. // return Error_manager(Error_code::CARRIER_TASK_TYPE_ERROR, Error_level::MINOR_ERROR,
  94. // "Dispatch_device_base::execute_one_level_task get_task_type() != CARRIER_TASK ");
  95. // }
  96. return Error_code::SUCCESS;
  97. }
  98. //判断能否执行任务
  99. Error_manager Dispatch_device_base::check_task_level(Dispatch_task_level dispatch_task_level)
  100. {
  101. // std::cout << " huli test :::: " << " m_dispatch_device_status = " << m_dispatch_device_status << std::endl;
  102. //加锁
  103. std::unique_lock<std::mutex> t_lock(m_lock);
  104. //只有当状态 不是正在执行当前等级的任务,并且当前等级的任务为空. 此时返回成功, 才能接受新的任务
  105. if ( m_dispatch_device_status >= DISPATCH_DEVICE_READY && m_dispatch_device_status <= DISPATCH_DEVICE_THREE_LEVEL_WORK )
  106. {
  107. switch ( dispatch_task_level )
  108. {
  109. case DISPATCH_TASK_ONE_LEVEL:
  110. {
  111. if ( ( m_dispatch_device_status == DISPATCH_DEVICE_READY ) && mp_device_one_level_task.get() == NULL)
  112. {
  113. return Error_code::SUCCESS;
  114. }
  115. break;
  116. }
  117. case DISPATCH_TASK_TWO_LEVEL:
  118. {
  119. if ( ( m_dispatch_device_status == DISPATCH_DEVICE_READY ||
  120. m_dispatch_device_status == DISPATCH_DEVICE_ONE_LEVEL_WORK ||
  121. m_dispatch_device_status == DISPATCH_DEVICE_ONE_LEVEL_OVER ) && mp_device_two_level_task.get() == NULL)
  122. {
  123. return Error_code::SUCCESS;
  124. }
  125. break;
  126. }
  127. case DISPATCH_TASK_THREE_LEVEL:
  128. {
  129. if ( ( m_dispatch_device_status == DISPATCH_DEVICE_READY ||
  130. m_dispatch_device_status == DISPATCH_DEVICE_ONE_LEVEL_OVER ) && mp_device_three_level_task.get() == NULL)
  131. {
  132. return Error_code::SUCCESS;
  133. }
  134. break;
  135. }
  136. default:
  137. {
  138. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  139. " Dispatch_device_base::check_task PARAMETER_ERROR ");
  140. break;
  141. }
  142. }
  143. return Error_manager(Error_code::DISPATCH_DEVICE_STATUS_BUSY, Error_level::NEGLIGIBLE_ERROR,
  144. " Dispatch_device_base::check_task is busy ");
  145. }
  146. else
  147. {
  148. // std::cout << " huli test :::: " << " 777777777777777777777777777777777777 = " << 777 << std::endl;
  149. // std::cout << " huli test :::: " << " m_dispatch_device_status = " << m_dispatch_device_status << std::endl;
  150. // std::cout << " huli test :::: " << " id = " << m_device_id << std::endl;
  151. return Error_manager(Error_code::DISPATCH_DEVICE_STATUS_ERROR, Error_level::MINOR_ERROR,
  152. " Dispatch_device_base::check_task error ");
  153. }
  154. return Error_code::SUCCESS;
  155. }
  156. //签收任务
  157. Error_manager Dispatch_device_base::sign_for_task(std::shared_ptr<Task_Base> p_task, Dispatch_task_level dispatch_task_level)
  158. {
  159. //加锁
  160. std::unique_lock<std::mutex> t_lock(m_lock);
  161. switch ( dispatch_task_level )
  162. {
  163. case DISPATCH_TASK_ONE_LEVEL:
  164. {
  165. mp_device_one_level_task = p_task;
  166. mp_device_one_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  167. break;
  168. }
  169. case DISPATCH_TASK_TWO_LEVEL:
  170. {
  171. mp_device_two_level_task = p_task;
  172. mp_device_two_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  173. break;
  174. }
  175. case DISPATCH_TASK_THREE_LEVEL:
  176. {
  177. mp_device_three_level_task = p_task;
  178. mp_device_three_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  179. break;
  180. }
  181. default:
  182. {
  183. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  184. " Dispatch_device_base::check_task PARAMETER_ERROR ");
  185. break;
  186. }
  187. }
  188. return Error_code::SUCCESS;
  189. }
  190. //检查状态,是否正常运行. (工作状态 和 是否能接受对应的任务无关)
  191. Error_manager Dispatch_device_base::check_status()
  192. {
  193. if ( m_dispatch_device_status == DISPATCH_DEVICE_READY )
  194. {
  195. return Error_code::SUCCESS;
  196. }
  197. else if ( m_dispatch_device_status >= DISPATCH_DEVICE_BUSY && m_dispatch_device_status <= DISPATCH_DEVICE_THREE_LEVEL_WORK)
  198. {
  199. return Error_manager(Error_code::DISPATCH_DEVICE_STATUS_BUSY, Error_level::NEGLIGIBLE_ERROR,
  200. " Dispatch_device_base::check_status is busy ");
  201. }
  202. else
  203. {
  204. return Error_manager(Error_code::DISPATCH_DEVICE_STATUS_ERROR, Error_level::MINOR_ERROR,
  205. " Dispatch_device_base::check_status error ");
  206. }
  207. return Error_code::SUCCESS;
  208. }
  209. //判断是否为待机,如果已经准备好,则可以执行任务。
  210. bool Dispatch_device_base::is_ready()
  211. {
  212. return (m_dispatch_device_status == DISPATCH_DEVICE_READY);
  213. }
  214. //结束任务单,里面会根据任务的故障等级修正 任务单的状态
  215. Error_manager Dispatch_device_base::end_task(std::shared_ptr<Task_Base> p_task)
  216. {
  217. LOG(INFO) << " ---Dispatch_device_base::end_task ---"<< this;
  218. std::unique_lock<std::mutex> t_lock(m_lock);
  219. //注:这里只修改任务单的状态, 搬运器的状态不管
  220. //在结束任务单时,将雷达任务状态改为 TASK_OVER 已结束
  221. //判断任务单的错误等级,
  222. if ( p_task->get_task_error_manager().get_error_level() < Error_level::MINOR_ERROR)
  223. {
  224. //强制改为TASK_OVER,不管它当前在做什么。
  225. p_task->set_task_statu(Task_Base::Task_statu::TASK_OVER);
  226. }
  227. else
  228. {
  229. //强制改为 TASK_ERROR,不管它当前在做什么。
  230. p_task->set_task_statu(Task_Base::Task_statu::TASK_ERROR);
  231. }
  232. return Error_code::SUCCESS;
  233. }
  234. //取消任务单,由发送方提前取消任务单
  235. Error_manager Dispatch_device_base::cancel_task(std::shared_ptr<Task_Base> p_task, Dispatch_task_level dispatch_task_level)
  236. {
  237. //找到对应的任务单
  238. switch ( dispatch_task_level )
  239. {
  240. case DISPATCH_TASK_ONE_LEVEL:
  241. {
  242. if ( m_dispatch_device_status == DISPATCH_DEVICE_ONE_LEVEL_WORK || m_dispatch_device_status == DISPATCH_DEVICE_ONE_LEVEL_OVER )
  243. {
  244. //如果正在执行一级任务, 那么取消当前指令, 然后降级
  245. m_execute_condition.notify_all(false);
  246. //确保内部线程已经停下
  247. while (m_execute_condition.is_working())
  248. {
  249. }
  250. cancel_command();
  251. {
  252. std::unique_lock<std::mutex> t_lock(m_lock);
  253. mp_device_one_level_task.reset();
  254. m_dispatch_device_status = DISPATCH_DEVICE_READY;
  255. }
  256. m_execute_condition.notify_all(true);
  257. }
  258. else
  259. {
  260. std::unique_lock<std::mutex> t_lock(m_lock);
  261. //否则直接销毁任务单
  262. mp_device_one_level_task.reset();
  263. }
  264. break;
  265. }
  266. case DISPATCH_TASK_TWO_LEVEL:
  267. {
  268. if ( m_dispatch_device_status == DISPATCH_DEVICE_TWO_LEVEL_WORK || m_dispatch_device_status == DISPATCH_DEVICE_TWO_LEVEL_OVER )
  269. {
  270. //如果正在执行一级任务, 那么取消当前指令, 然后降级
  271. m_execute_condition.notify_all(false);
  272. //确保内部线程已经停下
  273. while (m_execute_condition.is_working())
  274. {
  275. }
  276. cancel_command();
  277. {
  278. std::unique_lock<std::mutex> t_lock(m_lock);
  279. mp_device_two_level_task.reset();
  280. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_WORK;
  281. }
  282. m_execute_condition.notify_all(true);
  283. }
  284. else
  285. {
  286. std::unique_lock<std::mutex> t_lock(m_lock);
  287. //否则直接销毁任务单
  288. mp_device_one_level_task.reset();
  289. }
  290. break;
  291. }
  292. case DISPATCH_TASK_THREE_LEVEL:
  293. {
  294. if ( m_dispatch_device_status == DISPATCH_DEVICE_THREE_LEVEL_WORK || m_dispatch_device_status == DISPATCH_DEVICE_THREE_LEVEL_OVER )
  295. {
  296. //如果正在执行一级任务, 那么取消当前指令, 然后降级
  297. m_execute_condition.notify_all(false);
  298. //确保内部线程已经停下
  299. while (m_execute_condition.is_working())
  300. {
  301. }
  302. cancel_command();
  303. {
  304. std::unique_lock<std::mutex> t_lock(m_lock);
  305. mp_device_three_level_task.reset();
  306. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_WORK;
  307. }
  308. m_execute_condition.notify_all(true);
  309. }
  310. else
  311. {
  312. std::unique_lock<std::mutex> t_lock(m_lock);
  313. //否则直接销毁任务单
  314. mp_device_one_level_task.reset();
  315. }
  316. break;
  317. }
  318. default:
  319. {
  320. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  321. " Dispatch_device_base::cancel_task PARAMETER_ERROR ");
  322. break;
  323. }
  324. }
  325. //上级的任务单指针,改为死亡,表示任务已经失效.
  326. p_task->set_task_statu(Task_Base::Task_statu::TASK_DEAD);
  327. return Error_code::SUCCESS;
  328. }
  329. Dispatch_device_base::Dispatch_device_status Dispatch_device_base::get_dispatch_device_status()
  330. {
  331. return m_dispatch_device_status;
  332. }
  333. //获取硬件设备的状态, 必须子类继承
  334. Dispatch_device_base::Hardware_device_status Dispatch_device_base::get_actual_device_status()
  335. {
  336. return HARDWARE_DEVICE_UNKNOWN;
  337. }
  338. int Dispatch_device_base::get_device_id()
  339. {
  340. return m_device_id;
  341. }
  342. //执行外界任务的执行函数
  343. void Dispatch_device_base::execute_thread_fun()
  344. {
  345. LOG(INFO) << " Dispatch_device_base::execute_thread_fun() start " << this;
  346. Error_manager t_error;
  347. while (m_execute_condition.is_alive())
  348. {
  349. m_execute_condition.wait();
  350. if ( m_execute_condition.is_alive() )
  351. {
  352. std::this_thread::sleep_for(std::chrono::microseconds(1));
  353. std::this_thread::sleep_for(std::chrono::milliseconds(1));
  354. // std::this_thread::sleep_for(std::chrono::seconds(1));
  355. std::this_thread::yield();
  356. // std::cout << " huli test :::: " << " m_device_id = " << m_device_id << std::endl;
  357. // std::cout << " huli test :::: " << "aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa m_dispatch_device_status = " << m_dispatch_device_status << std::endl;
  358. switch ( (Dispatch_device_status)m_dispatch_device_status )
  359. {
  360. //核心任务, (三级任务)
  361. case DISPATCH_DEVICE_THREE_LEVEL_WORK:
  362. {
  363. if ( mp_device_three_level_task.get() != NULL )
  364. {
  365. mp_device_three_level_task->set_task_statu(Task_Base::Task_statu::TASK_WORKING);
  366. //执行三级任务
  367. write_task_to_memory(mp_device_three_level_task);
  368. //更新通信
  369. update_device_communication();
  370. //从内存中读数据到任务单
  371. t_error = check_and_read_memory_to_task(mp_device_three_level_task);
  372. if (t_error == NODATA)
  373. {
  374. //设备正常运行
  375. //延时1ms, snap7的通信效率偏慢, 不需要高频率检查
  376. std::this_thread::sleep_for(std::chrono::milliseconds(1));
  377. }
  378. else
  379. {
  380. if (t_error != SUCCESS)
  381. {
  382. mp_device_three_level_task->set_task_error_manager(t_error);
  383. }
  384. end_task(mp_device_three_level_task);
  385. m_dispatch_device_status = DISPATCH_DEVICE_THREE_LEVEL_OVER;
  386. }
  387. }
  388. else
  389. {
  390. //直接降级
  391. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_WORK;
  392. }
  393. break;
  394. }
  395. case DISPATCH_DEVICE_THREE_LEVEL_OVER:
  396. {
  397. //更新通信
  398. update_device_communication();
  399. if ( mp_device_three_level_task.get() != NULL )
  400. {
  401. //检查任务状态,
  402. //在 E_THREE_LEVEL_WORK 里面, 已经 设为 TASK_OVER 了.
  403. //等待发送方的新指令, (发送方会把状态改为回收, 表示这个任务结束)
  404. if ( mp_device_three_level_task->get_task_statu() == Task_Base::Task_statu::TASK_WITHDRAW )
  405. {
  406. //这里会通知任务已经释放, 然后销毁任务单, 并降级
  407. mp_device_three_level_task->set_task_statu(Task_Base::Task_statu::TASK_FREE);
  408. mp_device_three_level_task.reset();
  409. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_WORK;
  410. }
  411. //任务单重新创建, 调度创建的新的任务,那么回去继续工作
  412. else if ( mp_device_three_level_task->get_task_statu() == Task_Base::Task_statu::TASK_CREATED )
  413. {
  414. mp_device_three_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  415. m_dispatch_device_status = DISPATCH_DEVICE_THREE_LEVEL_WORK;
  416. }
  417. //else //保持不动, 直到发送方给定新的任务,
  418. }
  419. else
  420. {
  421. //直接降级
  422. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_WORK;
  423. }
  424. break;
  425. }
  426. case DISPATCH_DEVICE_TWO_LEVEL_WORK:
  427. {
  428. if ( mp_device_two_level_task.get() != NULL )
  429. {
  430. mp_device_two_level_task->set_task_statu(Task_Base::Task_statu::TASK_WORKING);
  431. //执行二级任务
  432. write_task_to_memory(mp_device_two_level_task);
  433. //更新通信
  434. update_device_communication();
  435. //从内存中读数据到任务单
  436. t_error = check_and_read_memory_to_task(mp_device_two_level_task);
  437. if (t_error == NODATA)
  438. {
  439. //设备正常运行
  440. //延时1ms, snap7的通信效率偏慢, 不需要高频率检查
  441. std::this_thread::sleep_for(std::chrono::milliseconds(1));
  442. }
  443. else
  444. {
  445. if (t_error != SUCCESS)
  446. {
  447. mp_device_two_level_task->set_task_error_manager(t_error);
  448. }
  449. end_task(mp_device_two_level_task);
  450. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_OVER;
  451. }
  452. }
  453. else
  454. {
  455. //直接降级
  456. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_WORK;
  457. }
  458. break;
  459. }
  460. case DISPATCH_DEVICE_TWO_LEVEL_OVER:
  461. {
  462. //更新通信
  463. update_device_communication();
  464. if ( mp_device_two_level_task.get() != NULL )
  465. {
  466. //检查任务状态,
  467. //在 E_TWO_LEVEL_WORK 里面, 已经 设为 TASK_OVER 了.
  468. //等待发送方的新指令, (发送方会把状态改为回收, 表示这个任务结束)
  469. if ( mp_device_two_level_task->get_task_statu() == Task_Base::Task_statu::TASK_WITHDRAW )
  470. {
  471. //这里会通知任务已经释放, 然后销毁任务单, 并降级
  472. mp_device_two_level_task->set_task_statu(Task_Base::Task_statu::TASK_FREE);
  473. mp_device_two_level_task.reset();
  474. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_WORK;
  475. }
  476. //任务单重新创建, 调度创建的新的任务,那么回去继续工作
  477. else if ( mp_device_two_level_task->get_task_statu() == Task_Base::Task_statu::TASK_CREATED )
  478. {
  479. mp_device_two_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  480. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_WORK;
  481. }
  482. //else //保持不动, 直到发送方给定新的任务,
  483. }
  484. else
  485. {
  486. //直接降级
  487. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_WORK;
  488. }
  489. break;
  490. }
  491. case DISPATCH_DEVICE_ONE_LEVEL_WORK:
  492. {
  493. if ( mp_device_one_level_task.get() != NULL )
  494. {
  495. mp_device_one_level_task->set_task_statu(Task_Base::Task_statu::TASK_WORKING);
  496. //执行一级任务,
  497. write_task_to_memory(mp_device_one_level_task);
  498. //更新通信
  499. update_device_communication();
  500. //从内存中读数据到任务单
  501. t_error = check_and_read_memory_to_task(mp_device_one_level_task);
  502. // std::cout << " huli test :::: " << " 1111111111111111111111111111111111111111 = " << 111 << std::endl;
  503. // std::cout << " huli test :::: " << " 12312312313131 = " << 123 << std::endl;
  504. // std::cout << " huli test :::: " << " t_error = " << t_error.to_string() << std::endl;
  505. // std::cout << " huli test :::: " << " 2222222222222222222222222222222222222222 = " << 222 << std::endl;
  506. if ( t_error == NODATA )
  507. {
  508. //设备正常运行
  509. //延时1ms, snap7的通信效率偏慢, 不需要高频率检查
  510. std::this_thread::sleep_for(std::chrono::milliseconds(1));
  511. }
  512. else
  513. {
  514. if ( t_error != SUCCESS )
  515. {
  516. mp_device_one_level_task->set_task_error_manager(t_error);
  517. }
  518. end_task(mp_device_one_level_task);
  519. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_OVER;
  520. }
  521. }
  522. else
  523. {
  524. //直接降级
  525. m_dispatch_device_status = DISPATCH_DEVICE_READY;
  526. }
  527. break;
  528. }
  529. case DISPATCH_DEVICE_ONE_LEVEL_OVER:
  530. {
  531. //更新通信
  532. update_device_communication();
  533. if ( mp_device_one_level_task.get() != NULL )
  534. {
  535. //检查任务状态,
  536. //在 E_ONE_LEVEL_WORK 里面, 已经 设为 TASK_OVER 了.
  537. //等待发送方的新指令, (发送方会把状态改为回收, 表示这个任务结束)
  538. if ( mp_device_one_level_task->get_task_statu() == Task_Base::Task_statu::TASK_WITHDRAW )
  539. {
  540. //这里会通知任务已经释放, 然后销毁任务单, 并降级
  541. mp_device_one_level_task->set_task_statu(Task_Base::Task_statu::TASK_FREE);
  542. mp_device_one_level_task.reset();
  543. m_dispatch_device_status = DISPATCH_DEVICE_READY;
  544. }
  545. //任务单重新创建, 调度创建的新的任务,那么回去继续工作
  546. else if ( mp_device_one_level_task->get_task_statu() == Task_Base::Task_statu::TASK_CREATED )
  547. {
  548. mp_device_one_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  549. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_WORK;
  550. }
  551. //else //保持不动, 直到发送方给定新的任务,
  552. }
  553. else
  554. {
  555. //直接降级
  556. m_dispatch_device_status = DISPATCH_DEVICE_READY;
  557. }
  558. break;
  559. }
  560. case DISPATCH_DEVICE_FAULT:
  561. {
  562. //更新通信
  563. update_device_communication();
  564. //所有任务报错, 并销毁任务.
  565. if ( mp_device_one_level_task.get() != NULL )
  566. {
  567. //添加错误码
  568. Error_manager t_error(DISPATCH_DEVICE_STATUS_ERROR, MINOR_ERROR, "m_respons_status is error");
  569. mp_device_one_level_task->set_task_error_manager(t_error);
  570. end_task(mp_device_one_level_task);
  571. mp_device_one_level_task.reset();
  572. }
  573. if ( mp_device_two_level_task.get() != NULL )
  574. {
  575. //添加错误码
  576. Error_manager t_error(DISPATCH_DEVICE_STATUS_ERROR, MINOR_ERROR, "m_respons_status is error");
  577. mp_device_two_level_task->set_task_error_manager(t_error);
  578. end_task(mp_device_two_level_task);
  579. mp_device_two_level_task.reset();
  580. }
  581. if ( mp_device_three_level_task.get() != NULL )
  582. {
  583. //添加错误码
  584. Error_manager t_error(DISPATCH_DEVICE_STATUS_ERROR, MINOR_ERROR, "m_respons_status is error");
  585. mp_device_three_level_task->set_task_error_manager(t_error);
  586. end_task(mp_device_three_level_task);
  587. mp_device_three_level_task.reset();
  588. }
  589. break;
  590. }
  591. case DISPATCH_DEVICE_DISCONNECT:
  592. {
  593. //更新通信
  594. update_device_communication();
  595. //所有任务报错, 并销毁任务.
  596. if ( mp_device_one_level_task.get() != NULL )
  597. {
  598. //添加错误码
  599. Error_manager t_error(DISPATCH_DEVICE_STATUS_DISCONNECT, MINOR_ERROR, "m_respons_status is error");
  600. mp_device_one_level_task->set_task_error_manager(t_error);
  601. end_task(mp_device_one_level_task);
  602. mp_device_one_level_task.reset();
  603. }
  604. if ( mp_device_two_level_task.get() != NULL )
  605. {
  606. //添加错误码
  607. Error_manager t_error(DISPATCH_DEVICE_STATUS_DISCONNECT, MINOR_ERROR, "m_respons_status is error");
  608. mp_device_two_level_task->set_task_error_manager(t_error);
  609. end_task(mp_device_two_level_task);
  610. mp_device_two_level_task.reset();
  611. }
  612. if ( mp_device_three_level_task.get() != NULL )
  613. {
  614. //添加错误码
  615. Error_manager t_error(DISPATCH_DEVICE_STATUS_DISCONNECT, MINOR_ERROR, "m_respons_status is error");
  616. mp_device_three_level_task->set_task_error_manager(t_error);
  617. end_task(mp_device_three_level_task);
  618. mp_device_three_level_task.reset();
  619. }
  620. break;
  621. }
  622. case DISPATCH_DEVICE_READY:
  623. {
  624. //更新通信
  625. update_device_communication();
  626. break;
  627. }
  628. default:
  629. {
  630. break;
  631. }
  632. }
  633. }
  634. }
  635. LOG(INFO) << " Dispatch_device_base::execute_thread_fun() end "<< this;
  636. return;
  637. }
  638. //执行线程工作函数, 正在执行任务单.
  639. Error_manager Dispatch_device_base::execute_thread_working(std::shared_ptr<Task_Base> p_task, Dispatch_device_status & device_status)
  640. {
  641. return Error_code::SUCCESS;
  642. }
  643. //执行线程工作函数, 已经完成任务单. 等待新的指令
  644. Error_manager Dispatch_device_base::execute_thread_over(std::shared_ptr<Task_Base> p_task, Dispatch_device_status & device_status)
  645. {
  646. return Error_code::SUCCESS;
  647. }
  648. //把任务单写入到内存中, 子类必须重载
  649. Error_manager Dispatch_device_base::write_task_to_memory(std::shared_ptr<Task_Base> p_task)
  650. {
  651. return Error_code::SUCCESS;
  652. }
  653. //更新设备底层通信数据, 子类必须重载
  654. Error_manager Dispatch_device_base::update_device_communication()
  655. {
  656. return Error_code::SUCCESS;
  657. }
  658. //从内存中读数据到任务单, 子类必须重载
  659. Error_manager Dispatch_device_base::check_and_read_memory_to_task(std::shared_ptr<Task_Base> p_task)
  660. {
  661. return Error_code::SUCCESS;
  662. }
  663. //取消下发的指令
  664. Error_manager Dispatch_device_base::cancel_command()
  665. {
  666. //以后再写 need programe
  667. //目前调度和plc的通信指令做的很简单,没有暂停和急停 复位等操作.
  668. //这里先空着,以后再写.
  669. //调度模块单方面销毁任务, 不管底层plc的执行情况, 也不去告知plc任务取消.
  670. return Error_code::SUCCESS;
  671. }