import utmech.mechanompu.actuator.*;
import utmech.mechanompu.*;
import utmech.mechanompu.io.*;

public class ServoTest {
    public static void main(String arg[]) {
        wheels.set_servo_mode(true);
        System.out.println("set vel (x5)");
        for (int i=0;i<5;i++) {
            int val;
            System.out.print("l("+wheels.get_lvel()+"):");
                                /* 現在速度を表示し、目標速度入力を促す */
            val=key.read_dec(); /* 10進数をキーから取得
                                   数字入力後、DATA SETキーを押す */
            System.out.println(val);
            wheels.set_goal_lvel(val);
            System.out.print("r("+wheels.get_rvel()+"):");
            val=key.read_dec();
            System.out.println(val);
            wheels.set_goal_rvel(val);
        }
    }
}