2 Years Ago
added simple pid implementation for controlling orientation when steering - needs more tuning