Open GarethG opened 12 years ago
Thought about this. Occupancy grid outputs data with x,y,and certainty co-ordinates. From this we can read where we are and get info on where we want to go. About keeping the map good, thinking when we start to map we should set the heading for north or a fixed position every time before starting slam. That way we have a good idea of where we're facing in the map. Gyro info in the form of the quaternion could be good enough, if not we can use the compass heading and figure it out from that.
The navigation stack takes a 2D occupancy grid and /tf and creates navigation solutions to set waypoints.