Set the position of Herkulex

        Enable torque using torque_on function before calling this

        Args:

            goalposition (int): The desired position, min-0 & max-1023
            goaltime (int): the time taken to move from present
             position to goalposition
            led (int): the LED color
                       0x00 LED off
                       0x04 GREEN
                       0x08 BLUE
                       0x10 RED

def set_servo_position(self, goalposition, goaltime, led):
        """ Set the position of Herkulex

        Enable torque using torque_on function before calling this

        Args:

            goalposition (int): The desired position, min-0 & max-1023
            goaltime (int): the time taken to move from present
             position to goalposition
            led (int): the LED color
                       0x00 LED off
                       0x04 GREEN
                       0x08 BLUE
                       0x10 RED
        """
        goalposition_msb = int(goalposition) >> 8
        goalposition_lsb = int(goalposition) & 0xff

        data = []
        data.append(0x0C)
        data.append(self.servoid)
        data.append(I_JOG_REQ)
        data.append(goalposition_lsb)
        data.append(goalposition_msb)
        data.append(led)
        data.append(self.servoid)
        data.append(goaltime)
        send_data(data)