Added PID python script (what was that?)
Fixed gimbal lock in IMU angular rates formula