ai_controller.xml 39 KB

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