🚀 Add PID controller 🎉 (backport #434, #975, #899, #1084, #951)

🚀 Add PID controller 🎉 (backport #434, #975, #899, #1084, #951) #566