Some simple servo tracking and hold/free

Added some simple commands to turn on servo tracking, which prints out
servo position, if it changes (as well as logical angle).  Also command
to hold servos and likewise free servos.