Created ServoModule which displays servo position

Created ServoModule which displays the current position of each servo
along with the state machine counter 'servoState.'
Added check in main script to ensure that second part of message can be
converted to a number.