File content as of revision 3:490e970d2795:

#include "mbed.h"
#include "SerialServo.h"
//#include "Servo.h"

SerialServo::SerialServo(PinName TX, PinName RX) : ser(TX, RX){
}

//初期化関数
void SerialServo::init(){
    ser.baud(115200);
    ser.format(8, Serial::Even, 1);
    tx_data[0] = 0;
    tx_data[1] = 0;
    tx_data[2] = 0;
}


//データ送信関数
void SerialServo::transmission(){
    ser.putc(tx_data[0]);
    ser.putc(tx_data[1]);
    ser.putc(tx_data[2]);
    //wait_us(1000);
}

//ポジション設定
void SerialServo::move(char id,int pos){
    int temp1 = (pos & 0x3F80) >> 7;
    int temp2 = pos & 0x7f;
    tx_data[0] = ICS_POS_CMD | id;
    tx_data[1] = (unsigned char)temp1;
    tx_data[2] = (unsigned char)temp2;
    transmission();//送信
}

void SerialServo::speed(char id,int spe){
    int temp1 = SUB_SP_COMMND;
    int temp2 = spe;
    tx_data[0] = ICS_PARA_WRITE_COMMND | id;
    tx_data[1] = (unsigned char)temp1;
    tx_data[2] = (unsigned char)temp2;
    transmission();//送信
}