Add command to get servo position