Added servomotor calibration utility and more