| 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; |