dispatch_device_base.cpp 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804
  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 ( mp_device_one_level_task.get() == NULL )
  112. {
  113. //一级任务直接插入
  114. if ( m_dispatch_device_status == DISPATCH_DEVICE_READY ||
  115. m_dispatch_device_status == DISPATCH_DEVICE_TWO_LEVEL_OVER ||
  116. m_dispatch_device_status == DISPATCH_DEVICE_TWO_LEVEL_WORK ||
  117. m_dispatch_device_status == DISPATCH_DEVICE_THREE_LEVEL_OVER ||
  118. m_dispatch_device_status == DISPATCH_DEVICE_THREE_LEVEL_WORK )
  119. {
  120. return Error_code::SUCCESS;
  121. }
  122. else
  123. {
  124. return Error_manager(Error_code::DISPATCH_DEVICE_TASK_LEVEL_ERROR, Error_level::MINOR_ERROR,
  125. " Dispatch_device_base::check_task_level error ");
  126. }
  127. }
  128. else
  129. {
  130. return Error_manager(Error_code::DISPATCH_DEVICE_TASK_REPEAT, Error_level::MINOR_ERROR,
  131. " Dispatch_device_base::check_task_level error ");
  132. }
  133. break;
  134. }
  135. case DISPATCH_TASK_TWO_LEVEL:
  136. {
  137. if ( mp_device_two_level_task.get() == NULL )
  138. {
  139. //二级任务如果打断了一级任务, 那么要通知一级任务暂停, 后续一级任务会重新执行
  140. if ( m_dispatch_device_status == DISPATCH_DEVICE_READY )
  141. {
  142. return Error_code::SUCCESS;
  143. }
  144. else if ( ( m_dispatch_device_status == DISPATCH_DEVICE_ONE_LEVEL_WORK ||
  145. m_dispatch_device_status == DISPATCH_DEVICE_ONE_LEVEL_OVER ) && mp_device_one_level_task.get() == NULL)
  146. {
  147. mp_device_one_level_task->set_task_statu(Task_Base::Task_statu::TASK_STOP);
  148. return Error_code::SUCCESS;
  149. }
  150. else
  151. {
  152. return Error_manager(Error_code::DISPATCH_DEVICE_TASK_LEVEL_ERROR, Error_level::MINOR_ERROR,
  153. " Dispatch_device_base::check_task_level error ");
  154. }
  155. }
  156. else
  157. {
  158. return Error_manager(Error_code::DISPATCH_DEVICE_TASK_REPEAT, Error_level::MINOR_ERROR,
  159. " Dispatch_device_base::check_task_level error ");
  160. }
  161. break;
  162. if ( ( m_dispatch_device_status == DISPATCH_DEVICE_READY ||
  163. m_dispatch_device_status == DISPATCH_DEVICE_ONE_LEVEL_WORK ||
  164. m_dispatch_device_status == DISPATCH_DEVICE_ONE_LEVEL_OVER ) && mp_device_two_level_task.get() == NULL)
  165. {
  166. return Error_code::SUCCESS;
  167. }
  168. break;
  169. }
  170. case DISPATCH_TASK_THREE_LEVEL:
  171. {
  172. if ( ( m_dispatch_device_status == DISPATCH_DEVICE_READY ||
  173. m_dispatch_device_status == DISPATCH_DEVICE_ONE_LEVEL_OVER ) && mp_device_three_level_task.get() == NULL)
  174. {
  175. return Error_code::SUCCESS;
  176. }
  177. break;
  178. }
  179. default:
  180. {
  181. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  182. " Dispatch_device_base::check_task PARAMETER_ERROR ");
  183. break;
  184. }
  185. }
  186. return Error_manager(Error_code::DISPATCH_DEVICE_STATUS_BUSY, Error_level::NEGLIGIBLE_ERROR,
  187. " Dispatch_device_base::check_task is busy ");
  188. }
  189. else
  190. {
  191. // std::cout << " huli test :::: " << " 777777777777777777777777777777777777 = " << 777 << std::endl;
  192. // std::cout << " huli test :::: " << " m_dispatch_device_status = " << m_dispatch_device_status << std::endl;
  193. // std::cout << " huli test :::: " << " id = " << m_device_id << std::endl;
  194. return Error_manager(Error_code::DISPATCH_DEVICE_STATUS_ERROR, Error_level::MINOR_ERROR,
  195. " Dispatch_device_base::check_task error ");
  196. }
  197. return Error_code::SUCCESS;
  198. }
  199. //签收任务
  200. Error_manager Dispatch_device_base::sign_for_task(std::shared_ptr<Task_Base> p_task, Dispatch_task_level dispatch_task_level)
  201. {
  202. //加锁
  203. std::unique_lock<std::mutex> t_lock(m_lock);
  204. switch ( dispatch_task_level )
  205. {
  206. case DISPATCH_TASK_ONE_LEVEL:
  207. {
  208. mp_device_one_level_task = p_task;
  209. mp_device_one_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  210. break;
  211. }
  212. case DISPATCH_TASK_TWO_LEVEL:
  213. {
  214. mp_device_two_level_task = p_task;
  215. mp_device_two_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  216. break;
  217. }
  218. case DISPATCH_TASK_THREE_LEVEL:
  219. {
  220. mp_device_three_level_task = p_task;
  221. mp_device_three_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  222. break;
  223. }
  224. default:
  225. {
  226. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  227. " Dispatch_device_base::check_task PARAMETER_ERROR ");
  228. break;
  229. }
  230. }
  231. return Error_code::SUCCESS;
  232. }
  233. //检查状态,是否正常运行. (工作状态 和 是否能接受对应的任务无关)
  234. Error_manager Dispatch_device_base::check_status()
  235. {
  236. if ( m_dispatch_device_status == DISPATCH_DEVICE_READY )
  237. {
  238. return Error_code::SUCCESS;
  239. }
  240. else if ( m_dispatch_device_status >= DISPATCH_DEVICE_BUSY && m_dispatch_device_status <= DISPATCH_DEVICE_THREE_LEVEL_WORK)
  241. {
  242. return Error_manager(Error_code::DISPATCH_DEVICE_STATUS_BUSY, Error_level::NEGLIGIBLE_ERROR,
  243. " Dispatch_device_base::check_status is busy ");
  244. }
  245. else
  246. {
  247. return Error_manager(Error_code::DISPATCH_DEVICE_STATUS_ERROR, Error_level::MINOR_ERROR,
  248. " Dispatch_device_base::check_status error ");
  249. }
  250. return Error_code::SUCCESS;
  251. }
  252. //结束任务单,里面会根据任务的故障等级修正 任务单的状态
  253. Error_manager Dispatch_device_base::end_task(std::shared_ptr<Task_Base> p_task)
  254. {
  255. LOG(INFO) << " ---Dispatch_device_base::end_task ---"<< this;
  256. //注:这里只修改任务单的状态, 搬运器的状态不管
  257. //在结束任务单时,将雷达任务状态改为 TASK_OVER 已结束
  258. //判断任务单的错误等级,
  259. if ( p_task->get_task_error_manager().get_error_level() < Error_level::MINOR_ERROR)
  260. {
  261. //强制改为TASK_OVER,不管它当前在做什么。
  262. p_task->set_task_statu(Task_Base::Task_statu::TASK_OVER);
  263. }
  264. else
  265. {
  266. //强制改为 TASK_ERROR,不管它当前在做什么。
  267. p_task->set_task_statu(Task_Base::Task_statu::TASK_ERROR);
  268. }
  269. return Error_code::SUCCESS;
  270. }
  271. //取消任务单,由发送方提前取消任务单
  272. Error_manager Dispatch_device_base::cancel_task(std::shared_ptr<Task_Base> p_task, Dispatch_task_level dispatch_task_level)
  273. {
  274. std::unique_lock<std::mutex> t_lock(m_lock);
  275. cancel_command();
  276. //找到对应的任务单
  277. switch ( dispatch_task_level )
  278. {
  279. case DISPATCH_TASK_ONE_LEVEL:
  280. {
  281. mp_device_one_level_task.reset();
  282. break;
  283. }
  284. case DISPATCH_TASK_TWO_LEVEL:
  285. {
  286. mp_device_two_level_task.reset();
  287. break;
  288. }
  289. case DISPATCH_TASK_THREE_LEVEL:
  290. {
  291. mp_device_three_level_task.reset();
  292. break;
  293. }
  294. default:
  295. {
  296. return Error_manager(Error_code::PARAMETER_ERROR, Error_level::MINOR_ERROR,
  297. " Dispatch_device_base::cancel_task PARAMETER_ERROR ");
  298. break;
  299. }
  300. }
  301. //上级的任务单指针,改为死亡,表示任务已经失效.
  302. p_task->set_task_statu(Task_Base::Task_statu::TASK_DEAD);
  303. return Error_code::SUCCESS;
  304. }
  305. //判断是否为待机,如果已经准备好,则可以执行任务。
  306. bool Dispatch_device_base::is_ready()
  307. {
  308. std::unique_lock<std::mutex> t_lock(m_lock);
  309. if ( m_dispatch_device_status == DISPATCH_DEVICE_READY &&
  310. m_device_one_level_command_key == "" &&
  311. m_device_two_level_command_key == "" &&
  312. m_device_three_level_command_key == "" )
  313. {
  314. return true;
  315. }
  316. else
  317. {
  318. return false;
  319. }
  320. }
  321. //判断是否可以执行存车任务。
  322. bool Dispatch_device_base::is_able_excute_store()
  323. {
  324. std::unique_lock<std::mutex> t_lock(m_lock);
  325. if ( m_device_one_level_command_key == "" )
  326. {
  327. if ( m_dispatch_device_status == DISPATCH_DEVICE_READY ||
  328. m_dispatch_device_status == DISPATCH_DEVICE_TWO_LEVEL_OVER ||
  329. m_dispatch_device_status == DISPATCH_DEVICE_TWO_LEVEL_WORK)
  330. {
  331. return true;
  332. }
  333. else if ( m_dispatch_device_status == DISPATCH_DEVICE_THREE_LEVEL_OVER ||
  334. m_dispatch_device_status == DISPATCH_DEVICE_THREE_LEVEL_WORK )
  335. {
  336. if ( m_device_three_level_process_type == Common_data::Dispatch_process_type::DISPATCH_PROCESS_PICKUP )
  337. {
  338. return true;
  339. }
  340. else
  341. {
  342. return false;
  343. }
  344. }
  345. else
  346. {
  347. return false;
  348. }
  349. }
  350. else
  351. {
  352. return false;
  353. }
  354. }
  355. //判断是否可以执行取车任务。
  356. bool Dispatch_device_base::is_able_excute_pickup()
  357. {
  358. std::unique_lock<std::mutex> t_lock(m_lock);
  359. if ( m_device_one_level_command_key == "" )
  360. {
  361. if ( m_dispatch_device_status == DISPATCH_DEVICE_READY ||
  362. m_dispatch_device_status == DISPATCH_DEVICE_TWO_LEVEL_OVER ||
  363. m_dispatch_device_status == DISPATCH_DEVICE_TWO_LEVEL_WORK)
  364. {
  365. return true;
  366. }
  367. else if ( m_dispatch_device_status == DISPATCH_DEVICE_THREE_LEVEL_OVER ||
  368. m_dispatch_device_status == DISPATCH_DEVICE_THREE_LEVEL_WORK )
  369. {
  370. if ( m_device_three_level_process_type == Common_data::Dispatch_process_type::DISPATCH_PROCESS_STORE )
  371. {
  372. return true;
  373. }
  374. else
  375. {
  376. return false;
  377. }
  378. }
  379. else
  380. {
  381. return false;
  382. }
  383. }
  384. else
  385. {
  386. return false;
  387. }
  388. }
  389. Dispatch_device_base::Dispatch_device_status Dispatch_device_base::get_dispatch_device_status()
  390. {
  391. return m_dispatch_device_status;
  392. }
  393. //获取硬件设备的状态, 必须子类继承
  394. Dispatch_device_base::Hardware_device_status Dispatch_device_base::get_actual_device_status()
  395. {
  396. return HARDWARE_DEVICE_UNKNOWN;
  397. }
  398. int Dispatch_device_base::get_device_id()
  399. {
  400. return m_device_id;
  401. }
  402. //执行外界任务的执行函数
  403. void Dispatch_device_base::execute_thread_fun()
  404. {
  405. LOG(INFO) << " Dispatch_device_base::execute_thread_fun() start " << this;
  406. Error_manager t_error;
  407. while (m_execute_condition.is_alive())
  408. {
  409. m_execute_condition.wait();
  410. if ( m_execute_condition.is_alive() )
  411. {
  412. std::this_thread::sleep_for(std::chrono::microseconds(1));
  413. std::this_thread::sleep_for(std::chrono::milliseconds(1));
  414. // std::this_thread::sleep_for(std::chrono::seconds(1));
  415. std::this_thread::yield();
  416. std::unique_lock<std::mutex> t_lock(m_lock);
  417. // std::cout << " huli test :::: " << " m_device_id = " << m_device_id << std::endl;
  418. // std::cout << " huli test :::: " << "aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa m_dispatch_device_status = " << m_dispatch_device_status << std::endl;
  419. switch ( (Dispatch_device_status)m_dispatch_device_status )
  420. {
  421. //核心任务, (三级任务)
  422. case DISPATCH_DEVICE_THREE_LEVEL_WORK:
  423. {
  424. if ( mp_device_three_level_task.get() != NULL )
  425. {
  426. mp_device_three_level_task->set_task_statu(Task_Base::Task_statu::TASK_WORKING);
  427. //执行三级任务
  428. write_task_to_memory(mp_device_three_level_task);
  429. //更新通信
  430. update_device_communication();
  431. //从内存中读数据到任务单
  432. t_error = check_and_read_memory_to_task(mp_device_three_level_task);
  433. if (t_error == NODATA)
  434. {
  435. //设备正常运行
  436. //延时1ms, snap7的通信效率偏慢, 不需要高频率检查
  437. std::this_thread::sleep_for(std::chrono::milliseconds(1));
  438. }
  439. else
  440. {
  441. if (t_error != SUCCESS)
  442. {
  443. mp_device_three_level_task->set_task_error_manager(t_error);
  444. }
  445. end_task(mp_device_three_level_task);
  446. m_dispatch_device_status = DISPATCH_DEVICE_THREE_LEVEL_OVER;
  447. }
  448. }
  449. else
  450. {
  451. //直接降级
  452. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_WORK;
  453. }
  454. break;
  455. }
  456. case DISPATCH_DEVICE_THREE_LEVEL_OVER:
  457. {
  458. //更新通信
  459. update_device_communication();
  460. if ( mp_device_three_level_task.get() != NULL )
  461. {
  462. //检查任务状态,
  463. //在 E_THREE_LEVEL_WORK 里面, 已经 设为 TASK_OVER 了.
  464. //等待发送方的新指令, (发送方会把状态改为回收, 表示这个任务结束)
  465. if ( mp_device_three_level_task->get_task_statu() == Task_Base::Task_statu::TASK_WITHDRAW )
  466. {
  467. //这里会通知任务已经释放, 然后销毁任务单, 并降级
  468. mp_device_three_level_task->set_task_statu(Task_Base::Task_statu::TASK_FREE);
  469. mp_device_three_level_task.reset();
  470. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_WORK;
  471. }
  472. //任务单重新创建, 调度创建的新的任务,那么回去继续工作
  473. else if ( mp_device_three_level_task->get_task_statu() == Task_Base::Task_statu::TASK_CREATED )
  474. {
  475. mp_device_three_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  476. m_dispatch_device_status = DISPATCH_DEVICE_THREE_LEVEL_WORK;
  477. }
  478. //else //保持不动, 直到发送方给定新的任务,
  479. }
  480. else
  481. {
  482. //直接降级
  483. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_WORK;
  484. }
  485. break;
  486. }
  487. case DISPATCH_DEVICE_TWO_LEVEL_WORK:
  488. {
  489. if ( mp_device_two_level_task.get() != NULL )
  490. {
  491. mp_device_two_level_task->set_task_statu(Task_Base::Task_statu::TASK_WORKING);
  492. //执行二级任务
  493. write_task_to_memory(mp_device_two_level_task);
  494. //更新通信
  495. update_device_communication();
  496. //从内存中读数据到任务单
  497. t_error = check_and_read_memory_to_task(mp_device_two_level_task);
  498. if (t_error == NODATA)
  499. {
  500. //设备正常运行
  501. //延时1ms, snap7的通信效率偏慢, 不需要高频率检查
  502. std::this_thread::sleep_for(std::chrono::milliseconds(1));
  503. }
  504. else
  505. {
  506. if (t_error != SUCCESS)
  507. {
  508. mp_device_two_level_task->set_task_error_manager(t_error);
  509. }
  510. end_task(mp_device_two_level_task);
  511. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_OVER;
  512. }
  513. }
  514. else
  515. {
  516. //直接降级
  517. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_WORK;
  518. }
  519. break;
  520. }
  521. case DISPATCH_DEVICE_TWO_LEVEL_OVER:
  522. {
  523. //更新通信
  524. update_device_communication();
  525. if ( mp_device_two_level_task.get() != NULL )
  526. {
  527. //检查任务状态,
  528. //在 E_TWO_LEVEL_WORK 里面, 已经 设为 TASK_OVER 了.
  529. //等待发送方的新指令, (发送方会把状态改为回收, 表示这个任务结束)
  530. if ( mp_device_two_level_task->get_task_statu() == Task_Base::Task_statu::TASK_WITHDRAW )
  531. {
  532. //这里会通知任务已经释放, 然后销毁任务单, 并降级
  533. mp_device_two_level_task->set_task_statu(Task_Base::Task_statu::TASK_FREE);
  534. mp_device_two_level_task.reset();
  535. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_WORK;
  536. }
  537. //任务单重新创建, 调度创建的新的任务,那么回去继续工作
  538. else if ( mp_device_two_level_task->get_task_statu() == Task_Base::Task_statu::TASK_CREATED )
  539. {
  540. mp_device_two_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  541. m_dispatch_device_status = DISPATCH_DEVICE_TWO_LEVEL_WORK;
  542. }
  543. //else //保持不动, 直到发送方给定新的任务,
  544. }
  545. else
  546. {
  547. //直接降级
  548. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_WORK;
  549. }
  550. break;
  551. }
  552. case DISPATCH_DEVICE_ONE_LEVEL_WORK:
  553. {
  554. if ( mp_device_one_level_task.get() != NULL )
  555. {
  556. if ( mp_device_one_level_task->get_task_statu() == Task_Base::Task_statu::TASK_WITHDRAW )
  557. {
  558. //这里会通知任务已经释放, 然后销毁任务单, 并降级
  559. mp_device_one_level_task->set_task_statu(Task_Base::Task_statu::TASK_FREE);
  560. mp_device_one_level_task.reset();
  561. m_dispatch_device_status = DISPATCH_DEVICE_READY;
  562. }
  563. else if (mp_device_one_level_task->get_task_statu() == Task_Base::Task_statu::TASK_CREATED ||
  564. mp_device_one_level_task->get_task_statu() == Task_Base::Task_statu::TASK_SIGNED ||
  565. mp_device_one_level_task->get_task_statu() == Task_Base::Task_statu::TASK_WORKING )
  566. {
  567. mp_device_one_level_task->set_task_statu(Task_Base::Task_statu::TASK_WORKING);
  568. //执行一级任务,
  569. write_task_to_memory(mp_device_one_level_task);
  570. //更新通信
  571. update_device_communication();
  572. //从内存中读数据到任务单
  573. t_error = check_and_read_memory_to_task(mp_device_one_level_task);
  574. if ( t_error == NODATA )
  575. {
  576. //设备正常运行
  577. //延时1ms, snap7的通信效率偏慢, 不需要高频率检查
  578. std::this_thread::sleep_for(std::chrono::milliseconds(1));
  579. }
  580. else
  581. {
  582. if ( t_error != SUCCESS )
  583. {
  584. mp_device_one_level_task->set_task_error_manager(t_error);
  585. }
  586. end_task(mp_device_one_level_task);
  587. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_OVER;
  588. }
  589. }
  590. //else等待发送方给新的指令. TASK_STOP 之后 不执行.
  591. }
  592. else
  593. {
  594. //直接降级
  595. m_dispatch_device_status = DISPATCH_DEVICE_READY;
  596. }
  597. break;
  598. }
  599. case DISPATCH_DEVICE_ONE_LEVEL_OVER:
  600. {
  601. //更新通信
  602. update_device_communication();
  603. if ( mp_device_one_level_task.get() != NULL )
  604. {
  605. //检查任务状态,
  606. //在 E_ONE_LEVEL_WORK 里面, 已经 设为 TASK_OVER 了.
  607. //等待发送方的新指令, (发送方会把状态改为回收, 表示这个任务结束)
  608. if ( mp_device_one_level_task->get_task_statu() == Task_Base::Task_statu::TASK_WITHDRAW )
  609. {
  610. //这里会通知任务已经释放, 然后销毁任务单, 并降级
  611. mp_device_one_level_task->set_task_statu(Task_Base::Task_statu::TASK_FREE);
  612. mp_device_one_level_task.reset();
  613. m_dispatch_device_status = DISPATCH_DEVICE_READY;
  614. }
  615. //任务单重新创建, 调度创建的新的任务,那么回去继续工作
  616. else if ( mp_device_one_level_task->get_task_statu() == Task_Base::Task_statu::TASK_CREATED )
  617. {
  618. mp_device_one_level_task->set_task_statu(Task_Base::Task_statu::TASK_SIGNED);
  619. m_dispatch_device_status = DISPATCH_DEVICE_ONE_LEVEL_WORK;
  620. }
  621. //else //保持不动, 直到发送方给定新的任务,
  622. }
  623. else
  624. {
  625. //直接降级
  626. m_dispatch_device_status = DISPATCH_DEVICE_READY;
  627. }
  628. break;
  629. }
  630. case DISPATCH_DEVICE_FAULT:
  631. {
  632. //更新通信
  633. update_device_communication();
  634. //所有任务报错, 并销毁任务.
  635. if ( mp_device_one_level_task.get() != NULL )
  636. {
  637. //添加错误码
  638. Error_manager t_error(DISPATCH_DEVICE_STATUS_ERROR, MINOR_ERROR, "m_respons_status is error");
  639. mp_device_one_level_task->set_task_error_manager(t_error);
  640. end_task(mp_device_one_level_task);
  641. mp_device_one_level_task.reset();
  642. }
  643. if ( mp_device_two_level_task.get() != NULL )
  644. {
  645. //添加错误码
  646. Error_manager t_error(DISPATCH_DEVICE_STATUS_ERROR, MINOR_ERROR, "m_respons_status is error");
  647. mp_device_two_level_task->set_task_error_manager(t_error);
  648. end_task(mp_device_two_level_task);
  649. mp_device_two_level_task.reset();
  650. }
  651. if ( mp_device_three_level_task.get() != NULL )
  652. {
  653. //添加错误码
  654. Error_manager t_error(DISPATCH_DEVICE_STATUS_ERROR, MINOR_ERROR, "m_respons_status is error");
  655. mp_device_three_level_task->set_task_error_manager(t_error);
  656. end_task(mp_device_three_level_task);
  657. mp_device_three_level_task.reset();
  658. }
  659. break;
  660. }
  661. case DISPATCH_DEVICE_DISCONNECT:
  662. {
  663. //更新通信
  664. update_device_communication();
  665. //所有任务报错, 并销毁任务.
  666. if ( mp_device_one_level_task.get() != NULL )
  667. {
  668. //添加错误码
  669. Error_manager t_error(DISPATCH_DEVICE_STATUS_DISCONNECT, MINOR_ERROR, "m_respons_status is error");
  670. mp_device_one_level_task->set_task_error_manager(t_error);
  671. end_task(mp_device_one_level_task);
  672. mp_device_one_level_task.reset();
  673. }
  674. if ( mp_device_two_level_task.get() != NULL )
  675. {
  676. //添加错误码
  677. Error_manager t_error(DISPATCH_DEVICE_STATUS_DISCONNECT, MINOR_ERROR, "m_respons_status is error");
  678. mp_device_two_level_task->set_task_error_manager(t_error);
  679. end_task(mp_device_two_level_task);
  680. mp_device_two_level_task.reset();
  681. }
  682. if ( mp_device_three_level_task.get() != NULL )
  683. {
  684. //添加错误码
  685. Error_manager t_error(DISPATCH_DEVICE_STATUS_DISCONNECT, MINOR_ERROR, "m_respons_status is error");
  686. mp_device_three_level_task->set_task_error_manager(t_error);
  687. end_task(mp_device_three_level_task);
  688. mp_device_three_level_task.reset();
  689. }
  690. break;
  691. }
  692. case DISPATCH_DEVICE_READY:
  693. {
  694. //更新通信
  695. update_device_communication();
  696. break;
  697. }
  698. default:
  699. {
  700. break;
  701. }
  702. }
  703. }
  704. }
  705. LOG(INFO) << " Dispatch_device_base::execute_thread_fun() end "<< this;
  706. return;
  707. }
  708. //执行线程工作函数, 正在执行任务单.
  709. Error_manager Dispatch_device_base::execute_thread_working(std::shared_ptr<Task_Base> p_task, Dispatch_device_status & device_status)
  710. {
  711. return Error_code::SUCCESS;
  712. }
  713. //执行线程工作函数, 已经完成任务单. 等待新的指令
  714. Error_manager Dispatch_device_base::execute_thread_over(std::shared_ptr<Task_Base> p_task, Dispatch_device_status & device_status)
  715. {
  716. return Error_code::SUCCESS;
  717. }
  718. //把任务单写入到内存中, 子类必须重载
  719. Error_manager Dispatch_device_base::write_task_to_memory(std::shared_ptr<Task_Base> p_task)
  720. {
  721. return Error_code::SUCCESS;
  722. }
  723. //更新设备底层通信数据, 子类必须重载
  724. Error_manager Dispatch_device_base::update_device_communication()
  725. {
  726. return Error_code::SUCCESS;
  727. }
  728. //从内存中读数据到任务单, 子类必须重载
  729. Error_manager Dispatch_device_base::check_and_read_memory_to_task(std::shared_ptr<Task_Base> p_task)
  730. {
  731. return Error_code::SUCCESS;
  732. }
  733. //取消下发的指令
  734. Error_manager Dispatch_device_base::cancel_command()
  735. {
  736. //以后再写 need programe
  737. //目前调度和plc的通信指令做的很简单,没有暂停和急停 复位等操作.
  738. //这里先空着,以后再写.
  739. //调度模块单方面销毁任务, 不管底层plc的执行情况, 也不去告知plc任务取消.
  740. return Error_code::SUCCESS;
  741. }