WebSVN - NaviCtrl - Diff - Rev 326 and 329

 #define REG_MAG_DATAY_MSB       0x05
 #define REG_MAG_DATAY_LSB       0x06
 #define REG_MAG_DATAZ_MSB       0x07
 #define REG_MAG_DATAZ_LSB       0x08
 #define REG_MAG_STATUS          0x09
 #define REG_MAG_IDA                     0x0A
 #define REG_MAG_IDB                     0x0B
 #define REG_MAG_IDC                     0x0C
+#define REG_MAG_IDF                     0x0F
 // bit mask for configuration mode
 #define CRA_MODE_MASK           0x03
 #define CRA_MODE_NORMAL         0x00    //default
+{
         u8 A;
         u8 B;
         u8 C;
 } __attribute__((packed)) Identification_t;
 volatile Identification_t NCMAG_Identification;
 typedef struct
+{
+        u8 Sub;
+} __attribute__((packed)) Identification2_t;
+volatile Identification2_t NCMAG_Identification2;
+typedef struct
+{
         u8 cra;
         u8 crb;
         u8 mode;
         if(RxBufferSize == sizeof(NCMAG_Identification) )
+        {
                 memcpy((u8 *)&NCMAG_Identification, pRxBuffer, sizeof(NCMAG_Identification));
+        }
+}
+void NCMAG_UpdateIdentification_Sub(u8* pRxBuffer, u8 RxBufferSize)
+{       // if number of bytes are matching
+        if(RxBufferSize == sizeof(NCMAG_Identification2))
+        {
+                memcpy((u8 *)&NCMAG_Identification2, pRxBuffer, sizeof(NCMAG_Identification2));
+        }
+}
 // rx data handler for magnetic sensor raw data
 void NCMAG_UpdateMagVector(u8* pRxBuffer, u8 RxBufferSize)
 {       // if number of bytes are matching
         if(RxBufferSize == sizeof(MagRawVector) )
         {       // byte order from big to little endian
+                }
+        }
         return(retval);
+}
+u8 NCMAG_GetIdentification_Sub(void)
+{
+        u8 retval = 0;
+        // try to catch the i2c buffer within 100 ms timeout
+        if(I2C_LockBuffer(100))
+        {
+                u16 TxBytes = 0;
+                NCMAG_Identification2.Sub = 0xFF;
+                I2C_Buffer[TxBytes++] = REG_MAG_IDF;
+                // initiate transmission
+                if(I2C_Transmission(MAG_SLAVE_ADDRESS, TxBytes, &NCMAG_UpdateIdentification_Sub, sizeof(NCMAG_Identification2)))
+                {
+                        if(I2C_WaitForEndOfTransmission(100))
+                        {
+                                if(I2C_Error == I2C_ERROR_NONE) retval = 1;
+                        }
+                }
+        }
+        return(retval);
+}
 // ----------------------------------------------------------------------------------------
 void NCMAG_GetMagVector(void)
+{
         // try to catch the I2C buffer within 0 ms
         if(retval) NCMAG_MagType = MAG_TYPE_LSM303DLH; // must be a LSM303DLH
         // polling of identification
         repeat = 0;
         do
+        {
+                retval = NCMAG_GetIdentification_Sub();
+                if(retval) break; // break loop on success
+                UART1_PutString(".");
+                repeat++;
+        }while(repeat < 12);
+        retval = 0;
+        do
+        {
                 retval = NCMAG_GetIdentification();
                 if(retval) break; // break loop on success
                 UART1_PutString(".");
                 repeat++;
         }while(repeat < 12);
         // if we got an answer to id request
         if(retval)
+        {
-                u8 n1[] = "HMC5843";
+                u8 n1[] = "\n\r HMC5843";
-                u8 n2[] = "LSM303DLH";
+                u8 n2[] = "\n\r LSM303DLH";
+                u8 n3[] = "\n\r LSM303DLM";
                 u8* pn;
+                pn = n1;
-                if(NCMAG_MagType == MAG_TYPE_LSM303DLH) pn = n2;
+                if(NCMAG_MagType == MAG_TYPE_LSM303DLH)
+                {
+                 if(NCMAG_Identification2.Sub == 0x3c) pn = n3;
-                else pn = n1;
+                 else pn = n2;
+                }
-                sprintf(msg, " %s ID%d/%d/%d", pn, NCMAG_Identification.A, NCMAG_Identification.B, NCMAG_Identification.C);
+                sprintf(msg, " %s ID 0x%02x/%02x/%02x-%02x", pn, NCMAG_Identification.A, NCMAG_Identification.B, NCMAG_Identification.C,NCMAG_Identification2.Sub);
                 UART1_PutString(msg);
                 if (    (NCMAG_Identification.A == MAG_IDA)
                      && (NCMAG_Identification.B == MAG_IDB)
                          && (NCMAG_Identification.C == MAG_IDC))
+                {
                         NCMAG_Present = 1;
-                        if(!NCMAG_SelfTest())
-                        {
-                                UART1_PutString(" Selftest failed!!!!!!!!!!!!!!!!!!!!");
-                                LED_RED_ON;
-                                NCMAG_IsCalibrated = 0;
-                        }
-                        else
-                        {
-                                if(EEPROM_Init())
+                        if(EEPROM_Init())
+                                {
                                         NCMAG_IsCalibrated = NCMag_CalibrationRead();
                                         if(!NCMAG_IsCalibrated) UART1_PutString("\r\n Not calibrated!");
+                                }
-                                else UART1_PutString("\r\n Calibration data not available!!!!!!!!!!!!!!!");
+                        else UART1_PutString("\r\n EEPROM data not available!!!!!!!!!!!!!!!");
+                        if(NCMAG_Identification2.Sub == 0x00)
+                        {
+                         if(!NCMAG_SelfTest())
+                         {
+                                UART1_PutString("\r\n Selftest failed!!!!!!!!!!!!!!!!!!!!\r\n");
+                                LED_RED_ON;
+                                NCMAG_IsCalibrated = 0;
+                         }      else UART1_PutString("\r\n Selftest ok");
+                        }
+                }
                 else
+                {
                         UART1_PutString("\n\r Not compatible!");
                         UART_VersionInfo.HardwareError[0] |= NC_ERROR0_COMPASS_INCOMPATIBLE;

Subversion Repositories NaviCtrl

(root)/tags/V2.02a/ncmag.c @ 481 - Rev 326 → 329