in progress

kondo.py

# -*- coding: utf-8 -*-
from struct import pack


class RCB_4HV(object):
    def __init__(self):
        pass

    def uni_servo(self, ics, speed, position):
        # uni servo control
        ret = '\x07'   # size
        ret += '\x0f'  # command
        ret += chr(ics)
        ret += chr(speed)
        ret += pack('<h', position)
        checksum = chr(sum(map(ord, ret)) % 256)
        ret += checksum
        return ret