Du meinst so: ?
Code:
void readCMPS03(void)
{
    word messung;
    byte messung_low, messung_high;
    Thread_Lock(1);
    RP6_writeCMD(0xC0, 2);

    RP6_writeCMD(0xC0, 1);

    messung_high = RP6_readRegister(0xC0, 2);
    messung_low = RP6_readRegister(0xC0, 1);
    messung = (( messung_high << 8 ) + messung_low);
    Thread_Lock(0);

    if (getStopwatch1() > 500) {
        print("Richtung: ");
        printInteger(messung / 10);
        println(" Grad");
        setStopwatch1(0);
    }
}
Das komische ist das dann die Grade nur ca. alle 20° ausgelesen werden - die dazwischen werden nicht ausgegeben.