optomised yaw for shortest path