677,6 → 677,9 |
// UART1_PutString("\r\nTilted"); |
return(0); |
} |
if(NCMAG_SensorType == TYPE_LSM303D) return(2); // der Sensor muss immer so verbaut sein, weil der interne ACC manchmal spinnt |
|
if(abs(AccRawVector.Z) + abs(AccRawVector.X) + abs(AccRawVector.Y) > 9000) return(0); // sensor defekt? |
// select orientation |
if(AccRawVector.Z > 3300) return(1); // Flach - Bestückung oben - Pfeil nach vorn |
else |
689,6 → 692,7 |
if(AccRawVector.Y > 3300) return(5); // Stehend - Pfeil nach oben - 'front' nach vorn |
else |
if(AccRawVector.Y < -3300) return(6); // Stehend - Pfeil nach unten - 'front' nach vorn |
|
return(0); |
} |
|
913,7 → 917,7 |
case TYPE_LSM303DLM: |
// MagConfig.crb = LSM303DLH_CRB_GAIN_19GA; |
MagConfig.crb = LSM303DLH_CRB_GAIN_40GA; // seit 2.03 -> 2.2014 |
MagConfig.cra = LSM303DLH_CRA_RATE_75HZ|CRA_MODE_NORMAL;; |
MagConfig.cra = LSM303DLH_CRA_RATE_75HZ|CRA_MODE_NORMAL; |
MagConfig.mode = MODE_CONTINUOUS; |
break; |
case TYPE_LSM303D: |
1001,7 → 1005,7 |
DebugOut.Analog[] = AccVector.X; |
DebugOut.Analog[] = AccVector.Y; |
DebugOut.Analog[] = AccVector.Z; |
s = 2; |
//s = 2; |
*/ |
} |
break; |