Updated PID tuning
Made it possible to specify yaw scale for the copter