ORIGIN [0,0]
GOAL [7,7]
0
1
2
3
4
5
6
7
8
9
10
11
12
ASTAR_HEURISTIC: MANHATTAN
GRID_RESOLUTION: 8x8
MARKER_DICT: ARUCO_4X4_50
DETECTION_FPS: 30
ARM_MODEL: MYCOBOT_600
DOF: 6
OCCUPANCY_MAP: LOADED
PATH_STATUS: OPTIMAL
COST: 12 STEPS
COLLISION: CLEAR
WAYPOINTS: COMPUTED
ARM_STATE: EXECUTING