Add orientation to optimal heading