Reorient to line

reorients the robot to the line after avoiding an obstacle. still kind of sketchy though.