add config for optimal heading controller