CU-Robosub / cusub

The CUSub repository
GNU General Public License v3.0
9 stars 1 forks source link

Waypoint nav no success indicator #103

Closed flamma7 closed 5 years ago

flamma7 commented 5 years ago

Waypoint navigator returns None instead of indicating success when reaching waypoint

flamma7 commented 5 years ago

Solved with a hack via proximity to goal point in latest jianshi branch

DrYerzinia commented 5 years ago

Solved via fixing the actual problem. Which I created and git blamed myself for in a massive self own. @flamma7 Do we want to change how the system works because right now we are using polling in the state machine all over the place. Not as simple as modifying block on reaching pose.

flamma7 commented 5 years ago

Did the SM polling get resolved? I noticed in z_place_localizer branch we are still calling self.checked_reach_pose() in block_on_reaching_pose(). We have another movement function called go_to_pose_non_blocking() which also calls self.checked_reached_pose(), perhaps for this we could have it check the status of the goal object instead of measuring distance, this way the waypoint nav always determines if we've actually reached the goal