ケンタ ミヤザキ / kondoSerialServo

kondoSerialservo krs6003rhv

Dependents:   quad_spider_nhk2019_04

SerialServo.h

Committer:
kenken0721
Date:
2019-02-16
Revision:
0:e7ccd59b1ab3
Child:
3:490e970d2795

File content as of revision 0:e7ccd59b1ab3:

#ifndef SERIALSERVO_H
#define SERIALSERVO_H

#define ICS_POS_CMD 0x80
#define ICS_PARA_WRITE_COMMND 0xC0
#define SUB_ST_COMMND 0x01
#define SUB_SP_COMMND 0x02

#include "mbed.h"


class SerialServo{
public  :
    SerialServo(PinName TX, PinName RX);
    void init();
    void move(char id,int pos);
    
private :
    Serial ser;
    unsigned char tx_data[3];
    void transmission();
};

#endif