changing test encoders
Merge branch 'experimental' of https://github.com/icoderaven/ardupilot into experimental
Merge with working version
adding P control for motors