FSM and Path Planning. Y-axis on camera does not work.