Hi,
ich hab vor einiger Zeit mal ein kleines Tesprogramm geschrieben. Da ist bis auf die Taster fast alles Drin. Du kannst es gerne Erweitern. Sehr schön ist das Programm auch nicht, weil es eins meiner ersten war. Aber kannstes dir ja trotzdem mal anschauen.
Code:
#include "asuro.h"
int main(void) {
unsigned int data1[2], data2[2], data3[2];
unsigned char x;
unsigned string[5];
int y;
Init();
BackLED(OFF,OFF);
Sleep(200);
OdometrieData(data1);
OdometrieData(data2);
SerWrite("\n\n\rOdometrie-test Motor: aus",28);
SerWrite("\n\rErste Messung: ",18);
PrintInt(data1[0]);
SerWrite(" - ",3);
PrintInt(data1[1]);
SerWrite("\n\rZweite Messung: ",18);
PrintInt(data2[0]);
SerWrite(" - ",3);
PrintInt(data2[1]);
BackLED(OFF,OFF);
MotorSpeed(150,150);
Msleep(5000);
OdometrieData(data1);
OdometrieData(data2);
SerWrite("\n\n\rOdometrie-test Motor: an (150,150)",37);
SerWrite("\n\rErste Messung: ",18);
PrintInt(data1[0]);
SerWrite(" - ",3);
PrintInt(data1[1]);
SerWrite("\n\rZweite Messung: ",18);
PrintInt(data2[0]);
SerWrite(" - ",3);
PrintInt(data2[1]);
MotorSpeed(0,0);
LineData(data1);
LineData(data2);
SerWrite("\n\n\rLinien-test Licht: aus",25);
SerWrite("\n\rErste Messung: ",18);
PrintInt(data1[0]);
SerWrite(" - ",3);
PrintInt(data1[1]);
SerWrite("\n\rZweite Messung: ",18);
PrintInt(data2[0]);
SerWrite(" - ",3);
PrintInt(data2[1]);
Msleep(3000);
FrontLED(ON);
Msleep(3000);
LineData(data1);
LineData(data2);
SerWrite("\n\n\rLinien-test Licht: an",25);
SerWrite("\n\rErste Messung: ",18);
PrintInt(data1[0]);
SerWrite(" - ",3);
PrintInt(data1[1]);
SerWrite("\n\rZweite Messung: ",18);
PrintInt(data2[0]);
SerWrite(" - ",3);
PrintInt(data2[1]);
FrontLED(OFF);
SerWrite("\n\n\rExterne Lichtquelle jetzt verwenden",39);
Msleep(3000);
SerWrite("\n\n\rTest startet in 10 sec",25);
Msleep(5000);
SerWrite("\n\n\rTest startet in 5 sec",24);
Msleep(5000);
SerWrite("\n\n\rTest startet jetzt",21);
LineData(data1);
LineData(data2);
SerWrite("\n\n\rLinien-test Licht: ext. Quelle",34);
SerWrite("\n\rLinker Liniensensor in 5 sec",30);
Msleep(5000);
SerWrite("\n\rLinks:",7);
PrintInt(data1[0]);
SerWrite("\n\rRechter Liniensensor in 5 sec",32);
Msleep(5000);
SerWrite("\n\rRechts:",9);
PrintInt(data1[1]);
Msleep(3000);
BackLED(OFF,OFF);
StatusLED(OFF);
FrontLED(OFF);
SerWrite("\n\n\rTaster-test",14);
SerWrite("\n\rKommt noch...",13);
while (1);
return 0;
}
mfg
Erik
Lesezeichen