Copter: wpnav lat-lon to roll-pitch at 100hz