InertialNav: fix for get_velocity_xy

forgot to sq
Copter: updated toy gains