#include "mbed.h"

DigitalOut myled(LED1);
Serial puchi(p13, p14);// tx,rx

void servo(int num, int value)
{
  puchi.putc(0xfd);
  puchi.putc(0xdd+num);
  puchi.putc(value);
  puchi.putc(value+num+1);
}

void moveTest(int n)
{
  for(int i= 0; i<220; i+=4) servo(n, i);
  for(int i= 220; i>0; i-=4) servo(n, i);
}

int main()
{
  puchi.baud(4800);
    while(1)
    {
      moveTest(0);
      moveTest(1);

      myled = 1;
      wait(0.2);
      myled = 0;
      wait(0.2);
  }
}

 1 
 2 
 3 
 4 RS232Cのオブジェクトを作る
 5 
 6 num番のサーボを位置valueに移動させる
 7 
 8 
 9 
10 
11 
12 
13 
14 テスト動作
15 
16 
17 
18 
19 
20 
21 
22 プチロボの基板は4800bps
23 
24 
25 0番のサーボモーターをテストする
26 1番のサーボモーターをテストする
27 
28 
29 
30 
31 
32 
33