Created a dedicated controller for adjustments based on walls. To allow corrections on the forward and forward_wall behaviors. Will try to adapt it to perform alignments when the robot is still.
Forward behavior should now try to align and keep it's distance to nearest wall.