To simplify logic for wrap-around cases and cases in which bins outside the FOV may be filled. Bin indices are offset such that the 0th bin is the first bin within the sensor FOV. This way we can always fill bins from smallest to largest index.
Calls function from ObstacleMath library that accounts for the vehicle's attitude w.r.t the obstacle. Obstacles are assumed to be flat, vertical walls.
* fixes to restart the state machine if sensor does not init correctly
Signed-off-by: dirksavage88 <dirksavage88@gmail.com>
* fixes
Signed-off-by: dirksavage88 <dirksavage88@gmail.com>
* increase fail count
Signed-off-by: dirksavage88 <dirksavage88@gmail.com>
* remove extra flush, switch from warn to debug, add enum states for sensor bring-up
Signed-off-by: dirksavage88 <dirksavage88@gmail.com>
* remove dead code, decrease restart fail count metric, break out of loop with consec errors if over the fail count and not init
Signed-off-by: dirksavage88 <dirksavage88@gmail.com>
---------
Signed-off-by: dirksavage88 <dirksavage88@gmail.com>