Updated the conditions for getting out of the 'forward' behavior on the control_motion node. Started work on the 'forward along wall' behavior.