ai_controller.xml 40 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941
  1. <?xml version="1.0" ?>
  2. <diagram author="Glenn De Jonghe" name="AI Tank">
  3. <description>
  4. Handling the npc tank.
  5. </description>
  6. <inport name="engine" />
  7. <top>
  8. from AIMap import AIMap
  9. import math
  10. from mymath import D1, D45, D360
  11. </top>
  12. <!-- constructor -->
  13. <class name="Main" default="true">
  14. <attribute name="tank" type="AITank"/>
  15. <attribute name="map" type="AIMap"/>
  16. <method name="Main">
  17. <parameter type="AITank" name="tank"></parameter>
  18. <body>
  19. self.tank = tank
  20. self.map = AIMap(tank.field.level)
  21. </body>
  22. </method>
  23. <relationships>
  24. <association class="Radar" name="radar" min="1" max="1" />
  25. <association class="EnemyTracker" name="enemy_tracker" min="1" max="1" />
  26. <association class="PilotStrategy" name="pilot_strategy" min="1" max="1" />
  27. <association class="ExplorePlanner" name="explore_planner" min="1" max="1" />
  28. <association class="AttackPlanner" name="attack_planner" min="1" max="1" />
  29. <association class="PathFinder" name="path_finder" min="1" max="1" />
  30. <association class="Steering" name="steering" min="1" max="1" />
  31. <association class="TurretSteering" name="turret_steering" min="1" max="1" />
  32. <association class="MotorControl" name="motor_control" min="1" max="1" />
  33. <association class="TurretControl" name="turret_control" min="1" max="1" />
  34. </relationships>
  35. <scxml initial="creation">
  36. <state id="error"/>
  37. <state id="creation" initial="state_1">
  38. <transition target="../error" event="instance_creation_error">
  39. <log>Instance creation error!</log>
  40. <!-- raise error event to handle error? -->
  41. </transition>
  42. <transition target="../error" event="instance_association_error">
  43. <log>Instance association error!</log>
  44. <!-- raise error event to handle error? -->
  45. </transition>
  46. <state id="state_1">
  47. <transition target="../state_2">
  48. <raise event="create_instance" scope="CD">
  49. <parameter expr="'turret_control'"/>
  50. <parameter expr="'TurretControl'"/>
  51. <parameter expr="SELF.tank"/>
  52. </raise>
  53. </transition>
  54. </state>
  55. <state id="state_2">
  56. <transition event="instance_created" target="../state_3"/>
  57. </state>
  58. <state id="state_3">
  59. <transition target="../state_4">
  60. <raise event="create_instance" scope="CD">
  61. <parameter expr="'motor_control'"/>
  62. <parameter expr="'MotorControl'"/>
  63. <parameter expr="SELF.tank"/>
  64. </raise>
  65. </transition>
  66. </state>
  67. <state id="state_4">
  68. <transition event="instance_created" target="../state_5"/>
  69. </state>
  70. <state id="state_5">
  71. <transition target="../state_6">
  72. <raise event="create_instance" scope="CD">
  73. <parameter expr="'turret_steering'"/>
  74. <parameter expr="'TurretSteering'"/>
  75. <parameter expr="SELF.tank"/>
  76. </raise>
  77. </transition>
  78. </state>
  79. <state id="state_6">
  80. <transition event="instance_created" target="../state_7"/>
  81. </state>
  82. <state id="state_7">
  83. <transition target="../state_8">
  84. <raise event="create_instance" scope="CD">
  85. <parameter expr="'steering'"/>
  86. <parameter expr="'Steering'"/>
  87. <parameter expr="SELF.tank"/>
  88. <parameter expr="SELF.map"/>
  89. </raise>
  90. </transition>
  91. </state>
  92. <state id="state_8">
  93. <transition event="instance_created" target="../state_9"/>
  94. </state>
  95. <state id="state_9">
  96. <transition target="../state_10">
  97. <raise event="create_instance" scope="CD">
  98. <parameter expr="'path_finder'"/>
  99. <parameter expr="'PathFinder'"/>
  100. <parameter expr="SELF.tank"/>
  101. <parameter expr="SELF.map"/>
  102. </raise>
  103. </transition>
  104. </state>
  105. <state id="state_10">
  106. <transition event="instance_created" target="../state_11"/>
  107. </state>
  108. <state id="state_11">
  109. <transition target="../state_12">
  110. <raise event="create_instance" scope="CD">
  111. <parameter expr="'attack_planner'"/>
  112. <parameter expr="'AttackPlanner'"/>
  113. </raise>
  114. </transition>
  115. </state>
  116. <state id="state_12">
  117. <transition event="instance_created" target="../state_13"/>
  118. </state>
  119. <state id="state_13">
  120. <transition target="../state_14">
  121. <raise event="create_instance" scope="CD">
  122. <parameter expr="'explore_planner'"/>
  123. <parameter expr="'ExplorePlanner'"/>
  124. <parameter expr="SELF.tank"/>
  125. <parameter expr="SELF.map"/>
  126. </raise>
  127. </transition>
  128. </state>
  129. <state id="state_14">
  130. <transition event="instance_created" target="../state_15"/>
  131. </state>
  132. <state id="state_15">
  133. <transition target="../state_16">
  134. <raise event="create_instance" scope="CD">
  135. <parameter expr="'pilot_strategy'"/>
  136. <parameter expr="'PilotStrategy'"/>
  137. </raise>
  138. </transition>
  139. </state>
  140. <state id="state_16">
  141. <transition event="instance_created" target="../state_17"/>
  142. </state>
  143. <state id="state_17">
  144. <transition target="../state_18">
  145. <raise event="create_instance" scope="CD">
  146. <parameter expr="'enemy_tracker'"/>
  147. <parameter expr="'EnemyTracker'"/>
  148. </raise>
  149. </transition>
  150. </state>
  151. <state id="state_18">
  152. <transition event="instance_created" target="../state_19"/>
  153. </state>
  154. <state id="state_19">
  155. <transition target="../state_20">
  156. <raise event="create_instance" scope="CD">
  157. <parameter expr="'radar'"/>
  158. <parameter expr="'Radar'"/>
  159. <parameter expr="SELF.tank"/>
  160. </raise>
  161. </transition>
  162. </state>
  163. <state id="state_20">
  164. <transition event="instance_created" target="../state_21"/>
  165. </state>
  166. <state id="state_21">
  167. <transition target="../end">
  168. <raise event="start_instance" scope="CD">
  169. <parameter expr="'turret_control'"/>
  170. </raise>
  171. <raise event="start_instance" scope="CD">
  172. <parameter expr="'motor_control'"/>
  173. </raise>
  174. <!-- Set turret steering associations -->
  175. <raise event="associate_instance" scope="CD">
  176. <parameter expr="'turret_control'"/>
  177. <parameter expr="'turret_steering/turret_control'"/>
  178. </raise>
  179. <raise event="associate_instance" scope="CD">
  180. <parameter expr="'attack_planner'"/>
  181. <parameter expr="'turret_steering/attack_planner'"/>
  182. </raise>
  183. <raise event="start_instance" scope="CD">
  184. <parameter expr="'turret_steering'"/>
  185. </raise>
  186. <!-- Set steering associations -->
  187. <raise event="associate_instance" scope="CD">
  188. <parameter expr="'motor_control'"/>
  189. <parameter expr="'steering/motor_control'"/>
  190. </raise>
  191. <raise event="associate_instance" scope="CD">
  192. <parameter expr="'path_finder'"/>
  193. <parameter expr="'steering/path_finder'"/>
  194. </raise>
  195. <raise event="start_instance" scope="CD">
  196. <parameter expr="'steering'"/>
  197. </raise>
  198. <!-- Set path finder associations -->
  199. <raise event="associate_instance" scope="CD">
  200. <parameter expr="'steering'"/>
  201. <parameter expr="'path_finder/steering'"/>
  202. </raise>
  203. <raise event="start_instance" scope="CD">
  204. <parameter expr="'path_finder'"/>
  205. </raise>
  206. <!-- Set attack planner associations -->
  207. <raise event="associate_instance" scope="CD">
  208. <parameter expr="'turret_steering'"/>
  209. <parameter expr="'attack_planner/turret_steering'"/>
  210. </raise>
  211. <raise event="associate_instance" scope="CD">
  212. <parameter expr="'turret_control'"/>
  213. <parameter expr="'attack_planner/turret_control'"/>
  214. </raise>
  215. <raise event="associate_instance" scope="CD">
  216. <parameter expr="'path_finder'"/>
  217. <parameter expr="'attack_planner/path_finder'"/>
  218. </raise>
  219. <raise event="start_instance" scope="CD">
  220. <parameter expr="'attack_planner'"/>
  221. </raise>
  222. <!-- Set explore planner associations -->
  223. <raise event="associate_instance" scope="CD">
  224. <parameter expr="'path_finder'"/>
  225. <parameter expr="'explore_planner/path_finder'"/>
  226. </raise>
  227. <raise event="start_instance" scope="CD">
  228. <parameter expr="'explore_planner'"/>
  229. </raise>
  230. <!-- Set pilot strategy associations -->
  231. <raise event="associate_instance" scope="CD">
  232. <parameter expr="'explore_planner'"/>
  233. <parameter expr="'pilot_strategy/explore_planner'"/>
  234. </raise>
  235. <raise event="associate_instance" scope="CD">
  236. <parameter expr="'attack_planner'"/>
  237. <parameter expr="'pilot_strategy/attack_planner'"/>
  238. </raise>
  239. <raise event="start_instance" scope="CD">
  240. <parameter expr="'pilot_strategy'"/>
  241. </raise>
  242. <!-- Set enemy_tracker associations -->
  243. <raise event="associate_instance" scope="CD">
  244. <parameter expr="'pilot_strategy'"/>
  245. <parameter expr="'enemy_tracker/pilot_strategy'"/>
  246. </raise>
  247. <raise event="associate_instance" scope="CD">
  248. <parameter expr="'attack_planner'"/>
  249. <parameter expr="'enemy_tracker/attack_planner'"/>
  250. </raise>
  251. <raise event="start_instance" scope="CD">
  252. <parameter expr="'enemy_tracker'"/>
  253. </raise>
  254. <!-- Set radar associations -->
  255. <raise event="associate_instance" scope="CD">
  256. <parameter expr="'pilot_strategy'"/>
  257. <parameter expr="'radar/pilot_strategy'"/>
  258. </raise>
  259. <raise event="associate_instance" scope="CD">
  260. <parameter expr="'enemy_tracker'"/>
  261. <parameter expr="'radar/enemy_tracker'"/>
  262. </raise>
  263. <raise event="start_instance" scope="CD">
  264. <parameter expr="'radar'"/>
  265. </raise>
  266. </transition>
  267. </state>
  268. <state id="end"/>
  269. </state>
  270. </scxml>
  271. </class>
  272. <!-- sensor -->
  273. <class name="Radar">
  274. <attribute name="tank" type="PlayerTank"/>
  275. <attribute name="range" init-value="2000"/>
  276. <relationships>
  277. <association class="EnemyTracker" name="enemy_tracker" min="1" max="1"/>
  278. <association class="PilotStrategy" name="pilot_strategy" min="1" max="1"/>
  279. </relationships>
  280. <method name="Radar">
  281. <parameter type="AITank" name="tank"/>
  282. <body>
  283. self.tank = tank
  284. </body>
  285. </method>
  286. <method name="isEnemyVisible" type="bool">
  287. <body>
  288. <![CDATA[
  289. sighted_list = self.tank.field.getSightedEnemies(self.tank, self.range)
  290. if len(sighted_list) > 0 :
  291. return True
  292. return False
  293. ]]>
  294. </body>
  295. </method>
  296. <method name="getEnemyPos" type="bool">
  297. <body>
  298. <![CDATA[
  299. sighted_list = self.tank.field.getSightedEnemies(self.tank, self.range)
  300. if len(sighted_list) > 0 :
  301. sighted_list.sort(key=lambda x: x[1])
  302. return sighted_list[0][0]
  303. else :
  304. return (-1,-1)
  305. ]]>
  306. </body>
  307. </method>
  308. <scxml initial="no_enemy">
  309. <state id="no_enemy">
  310. <transition cond="SELF.isEnemyVisible()" target="../enemy_in_sight">
  311. <raise event="enemy_sighted" target="'enemy_tracker'">
  312. <parameter expr="SELF.getEnemyPos()"/>
  313. </raise>
  314. <raise event="enemy_sighted" target="'pilot_strategy'">
  315. <parameter expr="SELF.getEnemyPos()"/>
  316. </raise>
  317. </transition>
  318. </state>
  319. <state id="enemy_in_sight">
  320. <transition cond="not SELF.isEnemyVisible()" target="../no_enemy">
  321. <raise event="enemy_out_of_sight" target="'enemy_tracker'"/>
  322. </transition>
  323. <!-- else, of course this is not present in scxml so add negated cond -->
  324. <transition event="update" port="engine" cond="SELF.isEnemyVisible()" target=".">
  325. <raise event="enemy_pos" target="'enemy_tracker'">
  326. <parameter expr="SELF.getEnemyPos()"/>
  327. </raise>
  328. </transition>
  329. </state>
  330. </scxml>
  331. </class>
  332. <!-- Memorizers -->
  333. <class name="EnemyTracker">
  334. <attribute name="enemy_pos" type="Position"/>
  335. <relationships>
  336. <association class="PilotStrategy" name="pilot_strategy" min="1" max="1"/>
  337. <association class="AttackPlanner" name="attack_planner" min="1" max="1"/>
  338. </relationships>
  339. <method name="hasEnemyMoved">
  340. <parameter name="new_position"/>
  341. <body>
  342. return new_position != self.enemy_pos
  343. </body>
  344. </method>
  345. <scxml initial="no_enemy">
  346. <state id="no_enemy">
  347. <transition event="enemy_sighted" target="../enemy_pos_known">
  348. <parameter name="enemy_position"/>
  349. <script>
  350. self.enemy_pos = enemy_position
  351. </script>
  352. </transition>
  353. </state>
  354. <state id="enemy_pos_known">
  355. <transition event="enemy_pos" cond="SELF.hasEnemyMoved(position)" target=".">
  356. <parameter name="position"/>
  357. <script>
  358. self.enemy_pos = position
  359. </script>
  360. <raise event="enemy_pos_changed" target="'attack_planner'">
  361. <parameter expr="SELF.enemy_pos"/>
  362. </raise>
  363. </transition>
  364. <transition event="enemy_out_of_sight" target="../enemy_pos_unsure">
  365. <raise event="enemy_out_of_sight" target="'attack_planner'"/>
  366. </transition>
  367. </state>
  368. <state id="enemy_pos_unsure">
  369. <transition event="destination_reached" target="../no_enemy">
  370. <raise event="enemy_lost" target="'pilot_strategy'"/>
  371. <log>raise enemy_lost</log>
  372. </transition>
  373. <transition event="enemy_sighted" target="../enemy_pos_known">
  374. <parameter name="position"/>
  375. <script>
  376. self.enemy_pos = position
  377. </script>
  378. </transition>
  379. </state>
  380. </scxml>
  381. </class>
  382. <!-- strategic deciders -->
  383. <class name="PilotStrategy">
  384. <relationships>
  385. <association class="ExplorePlanner" name="explore_planner" min="1" max="1"/>
  386. <association class="AttackPlanner" name="attack_planner" min="1" max="1"/>
  387. </relationships>
  388. <scxml initial="exploring">
  389. <state id="exploring">
  390. <onentry>
  391. <raise event="explore" target="'explore_planner'"/>
  392. </onentry>
  393. <onexit>
  394. <raise event="stop_exploring" target="'explore_planner'"/>
  395. </onexit>
  396. <transition event="enemy_sighted" target="../attacking">
  397. <parameter name="position"/>
  398. <raise event="attack" target="'attack_planner'">
  399. <parameter expr="position"/>
  400. </raise>
  401. </transition>
  402. </state>
  403. <state id="attacking">
  404. <onexit>
  405. <raise event="stop_attacking" target="'attack_planner'"/>
  406. <log>raise stop_attacking</log>
  407. </onexit>
  408. <transition event="enemy_lost" target="../exploring">
  409. <log>received enemy lost</log>
  410. </transition>
  411. </state>
  412. </scxml>
  413. </class>
  414. <!-- tactical deciders -->
  415. <class name="ExplorePlanner">
  416. <attribute name="map"/>
  417. <attribute name="tank"/>
  418. <relationships>
  419. <association class="PathFinder" name="path_finder" min="1" max="1"/>
  420. </relationships>
  421. <method name="ExplorePlanner">
  422. <parameter type="AITank" name="tank"/>
  423. <parameter type="AIMap" name="aimap"/>
  424. <body>
  425. self.tank = tank
  426. self.map = aimap
  427. </body>
  428. </method>
  429. <scxml initial="idle">
  430. <state id="idle">
  431. <transition event="explore" target="../exploring"/>
  432. </state>
  433. <state id="exploring" initial="no_destination">
  434. <transition event="stop_exploring" target="../idle">
  435. <log>stop_exploring received</log>
  436. </transition>
  437. <state id="no_destination">
  438. <transition target="../destination_set">
  439. <raise event="new_destination" target="'path_finder'">
  440. <parameter expr="SELF.map.getNewExplore(self.tank.getPosition(),self.tank.getAngle())"/>
  441. </raise>
  442. </transition>
  443. </state>
  444. <state id="destination_set">
  445. <transition event="destination_reached" target="../no_destination"/>
  446. </state>
  447. </state>
  448. </scxml>
  449. </class>
  450. <class name="AttackPlanner">
  451. <relationships>
  452. <association class="TurretSteering" name="turret_steering" min="1" max="1"/>
  453. <association class="PathFinder" name="path_finder" min="1" max="1"/>
  454. <association class="TurretControl" name="turret_control" min="1" max="1"/>
  455. </relationships>
  456. <scxml initial="idle">
  457. <state id="idle">
  458. <transition event="attack" target="../action">
  459. <log>received attack</log>
  460. <parameter name="enemy_pos"/>
  461. <raise event="new_destination" target="'path_finder'">
  462. <parameter expr="enemy_pos"/>
  463. </raise>
  464. <raise event="aim_at" target="'turret_steering'">
  465. <parameter expr="enemy_pos"/>
  466. </raise>
  467. </transition>
  468. </state>
  469. <parallel id="action">
  470. <transition event="stop_attacking" target="../idle">
  471. <log>received stop attack</log>
  472. <raise event="stop_aiming" target="'turret_steering'"/>
  473. </transition>
  474. <state id="movement">
  475. <state id="following">
  476. <transition event="enemy_pos_changed" target=".">
  477. <parameter name="enemy_pos"/>
  478. <raise event="new_destination" target="'path_finder'">
  479. <parameter expr="enemy_pos"/>
  480. </raise>
  481. <raise event="aim_at" target="'turret_steering'">
  482. <parameter expr="enemy_pos"/>
  483. </raise>
  484. </transition>
  485. <transition event="enemy_out_of_sight" target=".">
  486. <raise event="stop_aiming" target="'turret_steering'"/>
  487. </transition>
  488. </state>
  489. </state>
  490. <state id="shooting" initial="loaded">
  491. <state id="loaded">
  492. <transition event="ready_to_shoot" target="../reloading">
  493. <raise event="shoot" target="'turret_control'"/>
  494. <log>raise shoot</log>
  495. </transition>
  496. </state>
  497. <state id="reloading">
  498. <transition after="0.5" target="../loaded"/>
  499. </state>
  500. </state>
  501. </parallel>
  502. </scxml>
  503. </class>
  504. <class name="PathFinder">
  505. <attribute name="waypoints" init-value="[]"/>
  506. <attribute name="destination" init-value="(-1,-1)"/>
  507. <attribute name="map"/>
  508. <attribute name="tank" />
  509. <relationships>
  510. <association class="Steering" name="steering" min="1" max="1"/>
  511. </relationships>
  512. <method name="PathFinder">
  513. <parameter type="AITank" name="tank"/>
  514. <parameter type="AIMap" name="aimap"/>
  515. <body>
  516. self.tank = tank
  517. self.map = aimap
  518. </body>
  519. </method>
  520. <method name="calculatePath">
  521. <body>
  522. return self.map.calculatePath(self.tank.getPosition(), self.destination)
  523. </body>
  524. </method>
  525. <method name="requiresNewPath">
  526. <parameter name="new_destination"/>
  527. <body>
  528. return self.map.calculateCell(self.destination) != self.map.calculateCell(new_destination)
  529. </body>
  530. </method>
  531. <method name="morePoints">
  532. <body>
  533. return len(self.waypoints) > 0
  534. </body>
  535. </method>
  536. <scxml initial="idle">
  537. <state id="idle">
  538. <transition event="waypoint_reached" target="../check_points"/>
  539. <transition event="new_destination" cond="SELF.requiresNewPath(destination)" target="../check_points">
  540. <parameter name="destination"/>
  541. <script>
  542. self.destination = destination
  543. self.waypoints = self.calculatePath()
  544. </script>
  545. <!--
  546. <raise event="new_waypoint" target="'steering'">
  547. <parameter expr="SELF.waypoints[0]"/>
  548. </raise>
  549. -->
  550. </transition>
  551. </state>
  552. <state id="check_points">
  553. <transition cond=" SELF.morePoints()" target="../idle">
  554. <script>
  555. next_waypoint = self.waypoints.pop(0)
  556. </script>
  557. <raise event="new_waypoint" target="'steering'">
  558. <parameter expr="next_waypoint"/>
  559. </raise>
  560. </transition>
  561. <transition cond="not SELF.morePoints()" target="../idle">
  562. <raise event="destination_reached" scope="broad"/>
  563. </transition>
  564. </state>
  565. </scxml>
  566. </class>
  567. <!-- executors -->
  568. <class name="Steering">
  569. <attribute name="dest_waypoint" init-value="(-1,-1)"/>
  570. <attribute name="dest_cell" init-value="(-1,-1)"/>
  571. <attribute name="reaction_time" init-value="0.05"/>
  572. <attribute name="tank"/>
  573. <attribute name="map" />
  574. <attribute name="margin" init-value="0.2"/>
  575. <relationships>
  576. <association class="MotorControl" name="motor_control" min="1" max="1"/>
  577. <association class="PathFinder" name="path_finder" min="1" max="1"/>
  578. </relationships>
  579. <method name="Steering">
  580. <parameter type="AITank" name="tank"/>
  581. <parameter type="AIMap" name="aimap"/>
  582. <body>
  583. self.tank = tank
  584. self.map = aimap
  585. </body>
  586. </method>
  587. <method name="pointReached">
  588. <body>
  589. cell = self.map.calculateCell((self.tank.x, self.tank.y))
  590. return cell == self.dest_cell
  591. </body>
  592. </method>
  593. <method name="pointAhead">
  594. <body>
  595. <![CDATA[
  596. goal_angle = self.tank.angleToDest(self.dest_waypoint)
  597. diff = math.fabs(self.tank.angle - goal_angle)
  598. if diff <= (D45) :
  599. #self.tank.moveSpeed = int(math.ceil(((D45 - diff) / D45) * self.maxMoveSpeed))
  600. return True
  601. elif diff >= (D360 - D45) :
  602. #self.tank.moveSpeed = int(math.ceil(((diff - (D360 - D45)) / D45) * self.maxMoveSpeed))
  603. return True
  604. return False
  605. ]]>
  606. </body>
  607. </method>
  608. <method name="pointBehind">
  609. <body>
  610. <![CDATA[
  611. goal_angle = self.tank.angleToDest(self.dest_waypoint)
  612. diff = math.fabs(self.tank.angle - goal_angle)
  613. if diff <= (D45) or diff >= (D360 - D45) :
  614. return False
  615. return True
  616. ]]>
  617. </body>
  618. </method>
  619. <method name="pointRight">
  620. <body>
  621. <![CDATA[
  622. goal_angle = self.tank.angleToDest(self.dest_waypoint)
  623. diff = (self.tank.angle - goal_angle) % D360
  624. if diff >= self.margin and diff <= math.pi:
  625. return True
  626. return False
  627. ]]>
  628. </body>
  629. </method>
  630. <method name="pointLeft">
  631. <body>
  632. <![CDATA[
  633. goal_angle = self.tank.angleToDest(self.dest_waypoint)
  634. diff = (goal_angle - self.tank.angle) % D360
  635. if diff >= self.margin and diff <= math.pi:
  636. return True
  637. return False
  638. ]]>
  639. </body>
  640. </method>
  641. <method name="pointStraight">
  642. <body>
  643. <![CDATA[
  644. goal_angle = self.tank.angleToDest(self.dest_waypoint)
  645. diff = math.fabs(self.tank.angle - goal_angle)
  646. if diff < self.margin or diff > (D360- self.margin) :
  647. return True
  648. return False
  649. ]]>
  650. </body>
  651. </method>
  652. <scxml initial="idle">
  653. <state id="idle">
  654. <transition event="new_waypoint" target="../steering">
  655. <parameter name="dest_waypoint"/>
  656. <script>
  657. self.dest_waypoint = dest_waypoint
  658. self.dest_cell = self.map.calculateCell(dest_waypoint)
  659. </script>
  660. </transition>
  661. </state>
  662. <state id="steering" initial="forward_backward">
  663. <transition cond="SELF.pointReached()" target="../idle">
  664. <raise event="waypoint_reached" target="'path_finder'"/>
  665. </transition>
  666. <state id="forward_backward">
  667. <transition cond="SELF.pointAhead()" target="../left_right">
  668. <raise event="forward" target="'motor_control'"/>
  669. </transition>
  670. <transition cond="SELF.pointBehind()" target="../left_right">
  671. <raise event="stop" target="'motor_control'"/>
  672. </transition>
  673. </state>
  674. <state id="left_right">
  675. <transition cond="SELF.pointStraight()" target="../wait">
  676. <raise event="stop_turning" target="'motor_control'"/>
  677. </transition>
  678. <transition cond="SELF.pointLeft()" target="../wait">
  679. <raise event="turn_left" target="'motor_control'"/>
  680. </transition>
  681. <transition cond="SELF.pointRight()" target="../wait">
  682. <raise event="turn_right" target="'motor_control'"/>
  683. </transition>
  684. </state>
  685. <state id="wait">
  686. <transition after="SELF.reaction_time" target="../forward_backward"/>
  687. </state>
  688. </state>
  689. </scxml>
  690. </class>
  691. <class name="TurretSteering">
  692. <attribute name="reaction_time" init-value="0.05"/>
  693. <attribute name="tank"/>
  694. <attribute name="margin"/>
  695. <atribute name="target" init-value="(-1,-1)"/>
  696. <method name="TurretSteering">
  697. <parameter type="AITank" name="tank"/>
  698. <body>
  699. self.tank = tank
  700. self.margin = tank.cannonSpeed * D1
  701. </body>
  702. </method>
  703. <relationships>
  704. <association class="TurretControl" name="turret_control" min="1" max="1"/>
  705. <association class="AttackPlanner" name="attack_planner" min="1" max="1"/>
  706. </relationships>
  707. <method name="pointRight">
  708. <body>
  709. <![CDATA[
  710. goal_angle = self.tank.angleToDest(self.target)
  711. diff = (self.tank.cannonAngle - goal_angle) % D360
  712. if diff >= self.margin and diff <= math.pi:
  713. return True
  714. return False
  715. ]]>
  716. </body>
  717. </method>
  718. <method name="pointLeft">
  719. <body>
  720. <![CDATA[
  721. goal_angle = self.tank.angleToDest(self.target)
  722. diff = (goal_angle - self.tank.cannonAngle) % D360
  723. if diff >= self.margin and diff <= math.pi:
  724. return True
  725. return False
  726. ]]>
  727. </body>
  728. </method>
  729. <method name="pointCorrect">
  730. <body>
  731. <![CDATA[
  732. goal_angle = self.tank.angleToDest(self.target)
  733. diff = math.fabs(goal_angle - self.tank.cannonAngle)
  734. if diff < self.margin or diff > (D360- self.margin):
  735. return True
  736. return False
  737. ]]>
  738. </body>
  739. </method>
  740. <scxml initial="idle">
  741. <state id="idle">
  742. <transition event="aim_at" target="../aiming">
  743. <parameter name="target"/>
  744. <script>
  745. self.target = target
  746. </script>
  747. </transition>
  748. </state>
  749. <state id="aiming" initial="adjust">
  750. <transition event="stop_aiming" target="../idle">
  751. <raise event="stop_turning" target="'turret_control'"/>
  752. </transition>
  753. <transition event="aim_at" target=".">
  754. <parameter name="target"/>
  755. <script>
  756. self.target = target
  757. </script>
  758. </transition>
  759. <state id="adjust">
  760. <transition cond="SELF.pointRight()" target="../wait">
  761. <raise event="turn_right" target="'turret_control'"/>
  762. </transition>
  763. <transition cond="SELF.pointLeft()" target="../wait">
  764. <raise event="turn_left" target="'turret_control'"/>
  765. </transition>
  766. <transition cond="SELF.pointCorrect()" target="../wait">
  767. <raise event="stop_turning" target="'turret_control'"/>
  768. <raise event="ready_to_shoot" target="'attack_planner'"/>
  769. </transition>
  770. </state>
  771. <state id="wait">
  772. <transition after="SELF.reaction_time" target="../adjust"/>
  773. </state>
  774. </state>
  775. </scxml>
  776. </class>
  777. <!-- coordinators -->
  778. <!-- actuators -->
  779. <class name="MotorControl">
  780. <attribute name="tank"/>
  781. <method name="MotorControl">
  782. <parameter type="AITank" name="tank"/>
  783. <body>
  784. self.tank = tank
  785. </body>
  786. </method>
  787. <scxml>
  788. <parallel id="control">
  789. <state id="left_right" initial="stop">
  790. <state id="stop">
  791. <transition event="forward" target="../going_forward"/>
  792. <transition event="backward" target="../going_backward"/>
  793. </state>
  794. <state id="going_forward">
  795. <transition event="stop" target="../stop"/>
  796. <transition event="backward" target="../going_backward"/>
  797. <transition event="update" port="engine" target=".">
  798. <script>
  799. self.tank.moveUp()
  800. </script>
  801. </transition>
  802. </state>
  803. <state id="going_backward">
  804. <transition event="stop" target="../stop"/>
  805. <transition event="forward" target="../going_forward"/>
  806. <transition event="update" port="engine" target=".">
  807. <script>
  808. self.tank.moveDown()
  809. </script>
  810. </transition>
  811. </state>
  812. </state>
  813. <state id="forward_backward" initial="straight">
  814. <state id="straight">
  815. <transition event="turn_right" target="../turning_right"/>
  816. <transition event="turn_left" target="../turning_left"/>
  817. </state>
  818. <state id="turning_left">
  819. <transition event="stop_turning" target="../straight"/>
  820. <transition event="turn_right" target="../turning_right"/>
  821. <transition event="update" port="engine" target=".">
  822. <script>
  823. self.tank.turnLeft()
  824. </script>
  825. </transition>
  826. </state>
  827. <state id="turning_right">
  828. <transition event="stop_turning" target="../straight"/>
  829. <transition event="turn_left" target="../turning_left"/>
  830. <transition event="update" port="engine" target=".">
  831. <script>
  832. self.tank.turnRight()
  833. </script>
  834. </transition>
  835. </state>
  836. </state>
  837. </parallel>
  838. </scxml>
  839. </class>
  840. <class name="TurretControl">
  841. <attribute name="tank"/>
  842. <method name="TurretControl">
  843. <parameter type="AITank" name="tank"/>
  844. <body>
  845. self.tank = tank
  846. </body>
  847. </method>
  848. <scxml>
  849. <parallel id="turret">
  850. <state id="rotation" initial="none">
  851. <state id="none">
  852. <transition event="turn_right" target="../turning_right"/>
  853. <transition event="turn_left" target="../turning_left"/>
  854. </state>
  855. <state id="turning_left">
  856. <transition event="stop_turning" target="../none"/>
  857. <transition event="turn_right" target="../turning_right"/>
  858. <transition event="update" port="engine" target=".">
  859. <script>
  860. self.tank.turnCannonLeft()
  861. </script>
  862. </transition>
  863. </state>
  864. <state id="turning_right">
  865. <transition event="stop_turning" target="../none"/>
  866. <transition event="turn_left" target="../turning_left"/>
  867. <transition event="update" port="engine" target=".">
  868. <script>
  869. self.tank.turnCannonRight()
  870. </script>
  871. </transition>
  872. </state>
  873. </state>
  874. <state id="shooting">
  875. <state id="polling">
  876. <transition event="shoot" target=".">
  877. <script>
  878. self.tank.shoot()
  879. </script>
  880. </transition>
  881. </state>
  882. </state>
  883. </parallel>
  884. </scxml>
  885. </class>
  886. </diagram>