Roll/pitch hold controlled by JMX
Toned down derivative term, integral start at 0