drill_navigation.json 7.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327
  1. {
  2. "controller_port": 5277,
  3. "variable_list": [
  4. {
  5. "name": "probe_in_tracker",
  6. "type": "transform_obj"
  7. },
  8. {
  9. "name": "model_ref_in_tracker",
  10. "type": "transform_obj"
  11. },
  12. {
  13. "name": "model_in_model_ref",
  14. "type": "transform_obj"
  15. },
  16. {
  17. "name": "tool_ref_in_tracker",
  18. "type": "transform_obj"
  19. },
  20. {
  21. "name": "tool_in_tool_ref",
  22. "type": "transform_obj"
  23. },
  24. {
  25. "name": "probe_in_model_ref",
  26. "type": "transform_obj"
  27. },
  28. {
  29. "name": "probe_in_model",
  30. "type": "transform_obj"
  31. },
  32. {
  33. "name": "tool_in_model",
  34. "type": "transform_obj"
  35. },
  36. {
  37. "name": "probe_in_tool_ref",
  38. "type": "transform_obj"
  39. },
  40. {
  41. "name": "tip_in_model_ref",
  42. "type": "scalarxyz_obj"
  43. },
  44. {
  45. "name": "picked_point_in_model_ref",
  46. "type": "scalarxyz_obj"
  47. },
  48. {
  49. "name": "model_in_model_ref_error",
  50. "type": "double_obj"
  51. },
  52. {
  53. "name": "picked_probe_in_tool_ref",
  54. "type": "transform_obj"
  55. }
  56. ],
  57. "object_list": [
  58. {
  59. "type": "transform_tree",
  60. "name": "transform_tree",
  61. "init_config": {
  62. "node_list": [
  63. {
  64. "name": "tracker"
  65. },
  66. {
  67. "name": "probe",
  68. "parent": "tracker",
  69. "transform_var_name": "probe_in_tracker"
  70. },
  71. {
  72. "name": "model_ref",
  73. "parent": "tracker",
  74. "transform_var_name": "model_ref_in_tracker"
  75. },
  76. {
  77. "name": "model",
  78. "parent": "model_ref",
  79. "transform_var_name": "model_in_model_ref"
  80. },
  81. {
  82. "name": "tool_ref",
  83. "parent": "tracker",
  84. "transform_var_name": "tool_ref_in_tracker"
  85. },
  86. {
  87. "name": "tool",
  88. "parent": "tool_ref",
  89. "transform_var_name": "tool_in_tool_ref"
  90. }
  91. ]
  92. },
  93. "start_config": {
  94. "watch_list": [
  95. {
  96. "target": "probe",
  97. "observer": "model_ref",
  98. "transform_var_name": "probe_in_model_ref"
  99. },
  100. {
  101. "target": "probe",
  102. "observer": "model",
  103. "transform_var_name": "probe_in_model"
  104. },
  105. {
  106. "target": "tool",
  107. "observer": "model",
  108. "transform_var_name": "tool_in_model"
  109. },
  110. {
  111. "target": "probe",
  112. "observer": "tool_ref",
  113. "transform_var_name": "probe_in_tool_ref"
  114. }
  115. ]
  116. }
  117. },
  118. {
  119. "type": "ndi_interface",
  120. "name": "ndi",
  121. "init_config": {
  122. "address_type": "serial",
  123. "ip": "10.0.0.5",
  124. "tcp_port": 8765,
  125. "com_port": "/dev/ttyUSB0",
  126. "tool_list": [
  127. {
  128. "rom_path": "/home/tpx/data/roms/Probe_Big.rom",
  129. "outputs": {
  130. "transform": "probe_in_tracker"
  131. }
  132. },
  133. {
  134. "rom_path": "/home/tpx/data/roms/Drill_Ref_0322_3.rom",
  135. "outputs": {
  136. "transform": "tool_ref_in_tracker"
  137. }
  138. },
  139. {
  140. "rom_path": "/home/tpx/data/roms/Head_3Ball_1.rom",
  141. "outputs": {
  142. "transform": "model_ref_in_tracker"
  143. }
  144. }
  145. ]
  146. },
  147. "start_config": {
  148. "allow_unreliable": true,
  149. "prefer_stream_tracking": false
  150. }
  151. },
  152. {
  153. "type": "transform_obj_validity_watcher",
  154. "name": "probe_visibility_watcher",
  155. "start_config": {
  156. "variable_name": "probe_in_tracker"
  157. }
  158. },
  159. {
  160. "type": "transform_obj_validity_watcher",
  161. "name": "model_visibility_watcher",
  162. "start_config": {
  163. "variable_name": "model_ref_in_tracker"
  164. }
  165. },
  166. {
  167. "type": "transform_obj_validity_watcher",
  168. "name": "tool_visibility_watcher",
  169. "start_config": {
  170. "variable_name": "tool_ref_in_tracker"
  171. }
  172. },
  173. {
  174. "type": "scalarxyz_transformer",
  175. "name": "probe_tip_transformer_for_reg",
  176. "start_config": {
  177. "transform_type": "point",
  178. "transform_var_name": "probe_in_model_ref",
  179. "target_value": [
  180. 0,
  181. 0,
  182. 0
  183. ],
  184. "output_var_name": "tip_in_model_ref"
  185. },
  186. "dependencies": [
  187. "ndi",
  188. "transform_tree"
  189. ]
  190. },
  191. {
  192. "type": "transform_stabilizer",
  193. "name": "point_picker_for_reg",
  194. "start_config": {
  195. "stable_type": "point",
  196. "input_var_name": "tip_in_model_ref",
  197. "output_var_name": "picked_point_in_model_ref",
  198. "linear_tolerance_mm": 0.05,
  199. "temporal_interval_s": 3
  200. },
  201. "dependencies": [
  202. "probe_tip_transformer_for_reg"
  203. ]
  204. },
  205. {
  206. "type": "scalarxyz_obj_watcher",
  207. "name": "picked_point_watcher_for_reg",
  208. "start_config": {
  209. "variable_name": "picked_point_in_model_ref"
  210. }
  211. },
  212. {
  213. "type": "landmark_registration",
  214. "name": "model_registrator",
  215. "start_config": {
  216. "fiducial_points": [
  217. [
  218. 185.75326529376449,
  219. 149.3433422806243,
  220. 37.89585779283788
  221. ],
  222. [
  223. 154.32787238465744,
  224. 116.4095837766868,
  225. 28.39577397806383
  226. ],
  227. [
  228. 137.3846660114195,
  229. 112.52950379923068,
  230. 27.82314813339255
  231. ],
  232. [
  233. 116.28380784689239,
  234. 149.60532673304985,
  235. 28.430980391981475
  236. ],
  237. [
  238. 151.4594107171369,
  239. 127.58239816414866,
  240. 33.605828902057866
  241. ],
  242. [
  243. 151.37168103784265,
  244. 131.5925312645366,
  245. 35.12088213541559
  246. ]
  247. ],
  248. "point_var_name": "picked_point_in_model_ref",
  249. "transform_var_name": "model_in_model_ref",
  250. "error_var_name": "model_in_model_ref_error"
  251. },
  252. "dependencies": [
  253. "point_picker_for_reg"
  254. ]
  255. },
  256. {
  257. "type": "transform_obj_watcher",
  258. "name": "registration_result_watcher",
  259. "start_config": {
  260. "variable_name": "model_in_model_ref"
  261. }
  262. },
  263. {
  264. "type": "double_obj_watcher",
  265. "name": "registration_error_watcher",
  266. "start_config": {
  267. "variable_name": "model_in_model_ref_error"
  268. }
  269. },
  270. {
  271. "type": "transform_stabilizer",
  272. "name": "transform_picker_for_calib",
  273. "start_config": {
  274. "stable_type": "transform",
  275. "input_var_name": "probe_in_tool_ref",
  276. "output_var_name": "picked_probe_in_tool_ref",
  277. "linear_tolerance_mm": 0.05,
  278. "angular_tolerance_deg": 1,
  279. "temporal_interval_s": 3
  280. },
  281. "dependencies": [
  282. "ndi",
  283. "transform_tree"
  284. ]
  285. },
  286. {
  287. "type": "transform_obj_watcher",
  288. "name": "calibration_result_watcher",
  289. "start_config": {
  290. "variable_name": "tool_in_tool_ref"
  291. }
  292. },
  293. {
  294. "type": "empty_object",
  295. "name": "navigation",
  296. "dependencies": [
  297. "probe_visibility_watcher",
  298. "model_visibility_watcher",
  299. "tool_visibility_watcher",
  300. "ndi",
  301. "transform_tree"
  302. ]
  303. },
  304. {
  305. "type": "empty_object",
  306. "name": "reg_model",
  307. "dependencies": [
  308. "probe_visibility_watcher",
  309. "model_visibility_watcher",
  310. "picked_point_watcher_for_reg",
  311. "model_registrator",
  312. "registration_result_watcher",
  313. "registration_error_watcher"
  314. ]
  315. },
  316. {
  317. "type": "empty_object",
  318. "name": "calib_tool",
  319. "dependencies": [
  320. "probe_visibility_watcher",
  321. "tool_visibility_watcher",
  322. "transform_picker_for_calib",
  323. "calibration_result_watcher"
  324. ]
  325. }
  326. ]
  327. }