update_v0.9: PID additions
update_v0.9: Quaternion, Attitude update