Implemented facing and desired direction. Works perfectly