gehe zum Quellcode dieser Datei
Funktionen | |
void | IRDemo (void) |
void IRDemo | ( | void | ) |
Definiert in Zeile 107 der Datei IRDemo.c.
00108 { 00109 00110 static unsigned int cmd; 00111 unsigned char leftDir = FWD, rightDir = FWD; 00112 char text[7]; 00113 00114 Init(); 00115 InitRC5(); 00116 00117 SerPrint("RC5 Test\r\n"); 00118 while (1) 00119 { 00120 cmd = ReadRC5(); 00121 if (cmd) 00122 { 00123 cmd &= RC5_MASK; 00124 itoa(cmd, text, 16); 00125 SerPrint(text); 00126 SerPrint("\r\n"); 00127 00128 switch (cmd) 00129 { 00130 case TUNERRWD : 00131 case DIARWD : 00132 IRRwd(); 00133 break; 00134 case TUNERFWD : 00135 case DIAFWD : 00136 IRFwd(); 00137 break; 00138 case TUNERLEFT : 00139 case DIALEFT: 00140 IRLeft(); 00141 break; 00142 case TUNERRIGHT : 00143 case DIARIGHT: 00144 IRRight(); 00145 break; 00146 case TUNERSTOP : 00147 case DIASTOP : 00148 IRStop(); 00149 break; 00150 case TUNERPOWER : 00151 case DIAPOWER : 00152 return 0; 00153 break; 00154 } 00155 } 00156 if (speedLeft > 0 && speedLeft < OFFSET) speedLeft += OFFSET; 00157 if (speedLeft < 0 && speedLeft > -OFFSET) speedLeft -= OFFSET; 00158 if (speedRight > 0 && speedRight < OFFSET) speedRight += OFFSET; 00159 if (speedRight < 0 && speedRight > -OFFSET) speedRight -= OFFSET; 00160 00161 leftDir = rightDir = FWD; 00162 if (speedLeft < 0) leftDir = RWD; 00163 if (speedRight < 0) rightDir = RWD; 00164 00165 if (speedLeft > 255) speedLeft = 255; 00166 if (speedLeft < -255) speedLeft = -255; 00167 if (speedRight > 255) speedRight = 255; 00168 if (speedRight < -255) speedRight = -255; 00169 00170 MotorDir(leftDir,rightDir); 00171 MotorSpeed(abs(speedLeft),abs(speedRight)); 00172 Msleep(100); 00173 } 00174 return 0; 00175 }