Imageproc2.5 integration

Bringing in Ron's tweaks to motor controller software: ams-enc, amsCtrl, pid.c.
You can ignore the mpu6000/spi controller tweaks. They're not ready yet