[] Servo Feedback Calibration by classdisk

Servo calibrator using position feedback

This code finds and records the limit for each servo being tested it increments up, then down, until DeltaPos (h-t) ~= 0 at each limit for accuract, it waits 200ms between each reading, and smooths the position input from a poll of 100 readings, discarding the oulying 15% readings at each extreme The outer limit pulse and position for each servo are then recorded in an array