Calibrate.nxc

task main() {

    SetSensorLowspeed(S1);
    byte out;
    char tone;
    char result = ReadI2CRegister(S1,HT_ADDR_COMPASS, 0x41, out); //sicherung des Modus Bytes
    // result == NO_ERR erfolgreich
    if(result == NO_ERR) {
        result = WriteI2CRegister(S1,HT_ADDR_COMPASS, 0x41, 0x43); //calibration-modus
            if(result == NO_ERR) {
                //1x umdrehung in ca. 20 sekunden  danach wert lesen um kalibierung
                // zu beenden
                OnFwd(OUT_A, 5);
                OnFwd(OUT_B, 5);
                OnFwd(OUT_C, 5);
                result = WriteI2CRegister(S1,HT_ADDR_COMPASS, 0x41, 0x0); //normaler Modus
                if(result == NO_ERR) {
                    while(!ButtonPressed(BTNCENTER, true)) {
                        int angle = SensorHTCompass(S1);
                        //NumOut(1, LCD_LINE1, angle, 0x0);
                        TextOut(1, LCD_LINE1, "Winkel:" + NumToStr(angle), 0x01);
                        Wait(50);
                    }
                }
                else {
                    tone = PlayToneEx(TONE_E6, 50, 2, false);
                    Wait(20);
                    tone = PlayToneEx(TONE_E6, 50, 2, false);
                    TextOut(1, LCD_LINE2, "Fehler bei Aktivierung NormMode");
                }
            }
            else {
                tone = PlayToneEx(TONE_E6, 50, 2, false);
                Wait(20);
                tone = PlayToneEx(TONE_E6, 50, 2, false);
                TextOut(1, LCD_LINE2, "Fehler bei Aktivierung KalMode");
            }
    }
    else {
        tone = PlayToneEx(TONE_E6, 50, 2, false);
        Wait(20);
        tone = PlayToneEx(TONE_E6, 50, 2, false);
        TextOut(1, LCD_LINE2, "Fehler bei Sicherung des Registers!");
    }
    Wait(10000);
}