expanded wall distance code in state_estimator; working on wall following in move_planning