fsCoordinate.c
00001
00002
00003
00004
00005
00006
00007 #include "run_ctrl.h"
00008 #include <stdio.h>
00009 #include <stdlib.h>
00010
00011
00012 int main(int argc, char *argv[]) {
00013 int i;
00014
00015 if (initRunCtrl(argc, argv) < 0) {
00016 printf("initRunCtrl: %s\n", run_getError());
00017 exit(1);
00018 }
00019
00020 for (i = 0; i < 4; ++i) {
00021 int x, y, div16;
00022 run_followLine(FS, 0, 0, deg(90));
00023 run_getBodyPos(GL, &x, &y, &div16);
00024 printf("(%d, %d), %d\n", x, y, to_deg(div16));
00025 mWait(4000);
00026 mWait(2000);
00027 }
00028 run_stop();
00029
00030 return 0;
00031 }
00032