私の日記にサンプルプログラム集があるのですが、その中に「DRIVETEST」というプログラムがRaikiさんのやりたい事をしてると思います