| 1 | /****************************************************************************** | 
|---|
| 2 | * | 
|---|
| 3 | * @file    ads1260.c | 
|---|
| 4 | * @author  ECS, Joseph Zimmer | 
|---|
| 5 | * @version V1.0.0 | 
|---|
| 6 | * @date    25-04-2019 | 
|---|
| 7 | * @brief | 
|---|
| 8 | *            INITIALISIERUNG ADS1260: | 
|---|
| 9 | *            0. Setze die ADC Zustandsvariable auf ADC_STATE_INITIALIZE | 
|---|
| 10 | *    PIN CONFIG: | 
|---|
| 11 | *            1. ADC_POWER_DOWN_Pin auf 1 setzen                     -> ADS power up | 
|---|
| 12 | *            2. ADC_RESET_Pin auf 1 setzen                          -> ADS reset Zustand abschalten | 
|---|
| 13 | *            3. ADC_START_CONV_Pin auf 0 setzen                     -> ADS in Konfigurationsmodus ADC läuft nicht | 
|---|
| 14 | * | 
|---|
| 15 | *    WARTEN AUF: | 
|---|
| 16 | *            4. //  warten bis ADC_DATA_READY_Pin auf 1 ist             -> wenn auf 1 ist dann ist der Chip bereit für Kommunikation  // | 
|---|
| 17 | *               wurde ersetzt durch einschalten des Data Ready Interrupts dieser löst bei fallender Flanke aus | 
|---|
| 18 | *               die fallende Flanke wird generiert durch den ADS1260 wenn dieser mit der Data Conversion fertig ist. | 
|---|
| 19 | * | 
|---|
| 20 | *    REGISTER CONFIG: | 
|---|
| 21 | *            5. interne Referenzspannung 2.500V wird eingeschaltet, lässt sich mit ADC vom STM32G0 messen | 
|---|
| 22 | *            6. Samplerate auf 10 sps- setzen | 
|---|
| 23 | *            7. Filter auf FIR setzen | 
|---|
| 24 | *            8. Conversion Mode auf Mode Pulse setzen               -> nur eine Conversion wenn gestartet muss für jede neue Conversion neu aufgerufen werden | 
|---|
| 25 | *            9. Schalte AIN0 und AIN1 auf dem ADC | 
|---|
| 26 | *           10. Self Offset Calibration wird durchgeführt | 
|---|
| 27 | * | 
|---|
| 28 | *            x.  Setze die ADC Zustandsvariable auf ADC_STATE_CONVERSION_STOPPED | 
|---|
| 29 | * | 
|---|
| 30 | * | 
|---|
| 31 | * | 
|---|
| 32 | * | 
|---|
| 33 | *            REGISTER SCHREIBEN: | 
|---|
| 34 | * | 
|---|
| 35 | *            1.Byte 0x40 + Register Adresse || 2.Byte 0xXX Daten | 
|---|
| 36 | *            Bsp: | 
|---|
| 37 | *               Code 0x40 + Register 0x06, Daten 0x10 | 
|---|
| 38 | *               => 1.Byte 0x46,            => 2.Byte 0x10 | 
|---|
| 39 | * | 
|---|
| 40 | * | 
|---|
| 41 | * | 
|---|
| 42 | ******************************************************************************/ | 
|---|
| 43 |  | 
|---|
| 44 | //      --- INCLUDES ----------------------------------------------------------------- | 
|---|
| 45 | #include "ads1260.h" | 
|---|
| 46 | #include "spi.h" | 
|---|
| 47 | #include "math.h" | 
|---|
| 48 | #include "main.h" | 
|---|
| 49 | #include "eeprom.h" | 
|---|
| 50 | #include <stdio.h> | 
|---|
| 51 | //      --- EXTERNE VARIABLEN -------------------------------------------------------- | 
|---|
| 52 |  | 
|---|
| 53 | //      --- LOKALE DEFINES - bitte hier dokumentieren -------------------------------- | 
|---|
| 54 |  | 
|---|
| 55 | /*************************************************************************************************************/ | 
|---|
| 56 |  | 
|---|
| 57 | /*************************************************************************************************************/ | 
|---|
| 58 | #define VOLTAGE                                     (0) | 
|---|
| 59 | #define CURRENT                                     (1) | 
|---|
| 60 | #define TEMPERATURE                                 (2) | 
|---|
| 61 |  | 
|---|
| 62 | #define DEFAULT_ADS1260_TRANSMIT_TIMEOUT            (10) | 
|---|
| 63 | #define DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT    (10) | 
|---|
| 64 | #define ADS1260_SELF_OFFSET_CALIBRATION_TIMEOUT     (2000)    // > 16 * sampletime muss eingestellt werden | 
|---|
| 65 | #define ADS1260_SYSTEM_OFFSET_CALIBRATION_TIMEOUT   (2000) | 
|---|
| 66 | #define ADS1260_GAIN_CALIBRATION_TIMEOUT            (2000) | 
|---|
| 67 |  | 
|---|
| 68 | #define COMMAND_POS                                 (0) | 
|---|
| 69 | #define SEND_DATA_POS                               (1) | 
|---|
| 70 | #define RECEIVE_DATA_POS                            (2) | 
|---|
| 71 |  | 
|---|
| 72 | #define SEND_DATA_NR_OF_BYTES                       (2) | 
|---|
| 73 | #define RECEIVE_DATA_NR_OF_BYTES                    (3) | 
|---|
| 74 | #define DATA_ARRAY_SIZE                             (3) | 
|---|
| 75 |  | 
|---|
| 76 | #define REGISTER_READ_COMMAND                     (1 << 5) | 
|---|
| 77 | #define REGISTER_WRITE_COMMAND                    (1 << 6) | 
|---|
| 78 |  | 
|---|
| 79 | #define SYSTEM_OFFSET_CALIBRATION_COMMAND         (0x16) | 
|---|
| 80 | #define GAIN_CALIBRATION_COMMAND                  (0x17) | 
|---|
| 81 | #define SELF_OFFSET_CALIBRATION_COMMAND           (0x19) | 
|---|
| 82 | // Register Number: | 
|---|
| 83 | #define DATA_RATE_REGISTER                                        (0x02) | 
|---|
| 84 | #define DATA_RATE_2_5                             (0b00000 << 3) | 
|---|
| 85 | #define DATA_RATE_5                               (0b00001 << 3) | 
|---|
| 86 | #define DATA_RATE_10                              (0b00010 << 3) | 
|---|
| 87 | #define DATA_RATE_16_6                            (0b00011 << 3) | 
|---|
| 88 | #define DATA_RATE_20                              (0b00100 << 3)/*Default*/ | 
|---|
| 89 | #define DATA_RATE_50                              (0b00101 << 3) | 
|---|
| 90 | #define DATA_RATE_60                              (0b00110 << 3) | 
|---|
| 91 | #define DATA_RATE_100                             (0b00111 << 3) | 
|---|
| 92 | #define DATA_RATE_400                             (0b01000 << 3) | 
|---|
| 93 | #define DATA_RATE_1200                            (0b01001 << 3) | 
|---|
| 94 | #define DATA_RATE_2400                            (0b01010 << 3) | 
|---|
| 95 | #define DATA_RATE_4800                            (0b01011 << 3) | 
|---|
| 96 | #define DATA_RATE_7200                            (0b01100 << 3) | 
|---|
| 97 | #define DATA_RATE_14400                           (0b01101 << 3) | 
|---|
| 98 | #define DATA_RATE_19200                           (0b01110 << 3) | 
|---|
| 99 | #define DATA_RATE_25600                           (0b01111 << 3) | 
|---|
| 100 | #define DATA_RATE_40000                           (0b10000 << 3) | 
|---|
| 101 | #define DATA_RATE_RESET_MASK                     ~(0b11111 << 3) | 
|---|
| 102 |  | 
|---|
| 103 | #define DIGITAL_FILTER_REGISTER                                   (DATA_RATE_REGISTER) | 
|---|
| 104 | #define FILTER_SINC1                              (0b000 << 0) | 
|---|
| 105 | #define FILTER_SINC2                              (0b001 << 0) | 
|---|
| 106 | #define FILTER_SINC3                              (0b010 << 0) | 
|---|
| 107 | #define FILTER_SINC4                              (0b011 << 0) | 
|---|
| 108 | #define FILTER_FIR                                (0b100 << 0)/*Default*/ | 
|---|
| 109 | #define FILTER_RESET_MASK                        ~(0b111 << 0) | 
|---|
| 110 |  | 
|---|
| 111 |  | 
|---|
| 112 | #define CHOP_MODE_REGISTER                                        (0x03) | 
|---|
| 113 | #define CHOP_MODE_NORMAL                          (0b00 << 5)/*Default*/ | 
|---|
| 114 | #define CHOP_MODE_CHOP_MODE                       (0b01 << 5) | 
|---|
| 115 | #define CHOP_MODE_RESET_MASK                     ~(0b11 << 5)/*Default*/ | 
|---|
| 116 |  | 
|---|
| 117 | #define CONVERSION_MODE_REGISTER                                  (CHOP_MODE_REGISTER) | 
|---|
| 118 | #define CONVERSION_MODE_CONTINIOUS                (0 << 4)/*Default*/ | 
|---|
| 119 | #define CONVERSION_MODE_PULSE                     (1 << 4) | 
|---|
| 120 | #define CONVERSION_MODE_RESET_MASK               ~(1 << 4) | 
|---|
| 121 |  | 
|---|
| 122 | #define CONVERSION_START_DELAY_REGISTER                           (CHOP_MODE_REGISTER) | 
|---|
| 123 | #define CONVERSION_START_DELAY_0u                 (0b0000 << 0) | 
|---|
| 124 | #define CONVERSION_START_DELAY_50u                (0b0001 << 0)/*Default*/ | 
|---|
| 125 | #define CONVERSION_START_DELAY_59u                (0b0010 << 0) | 
|---|
| 126 | #define CONVERSION_START_DELAY_67u                (0b0011 << 0) | 
|---|
| 127 | #define CONVERSION_START_DELAY_85u                (0b0100 << 0) | 
|---|
| 128 | #define CONVERSION_START_DELAY_119u               (0b0101 << 0) | 
|---|
| 129 | #define CONVERSION_START_DELAY_189u               (0b0110 << 0) | 
|---|
| 130 | #define CONVERSION_START_DELAY_328u               (0b0111 << 0) | 
|---|
| 131 | #define CONVERSION_START_DELAY_605u               (0b1000 << 0) | 
|---|
| 132 | #define CONVERSION_START_DELAY_1_16m              (0b1001 << 0) | 
|---|
| 133 | #define CONVERSION_START_DELAY_2_27m              (0b1010 << 0) | 
|---|
| 134 | #define CONVERSION_START_DELAY_4_49m              (0b1011 << 0) | 
|---|
| 135 | #define CONVERSION_START_DELAY_8_89m              (0b1100 << 0) | 
|---|
| 136 | #define CONVERSION_START_DELAY_17_8m              (0b1101 << 0) | 
|---|
| 137 | #define CONVERSION_START_RESET_MASK              ~(0b1111 << 0) | 
|---|
| 138 |  | 
|---|
| 139 |  | 
|---|
| 140 |  | 
|---|
| 141 | #define REFERENCE_CONFIG_REGISTER                                 (0x06) | 
|---|
| 142 | #define INTERNAL_REFERENCE_ENABLE                 (1 << 4) | 
|---|
| 143 | #define INTERNAL_REFERENCE_DISABLE                (0 << 4)/*Default*/ | 
|---|
| 144 | #define INTERNAL_REFERENCE_RESET_MASK            ~(1 << 4) | 
|---|
| 145 |  | 
|---|
| 146 | #define SELECT_POS_REFERENCE_INTERNAL             (0b00 << 2) | 
|---|
| 147 | #define SELECT_POS_REFERENCE_AVDD                 (0b01 << 2)/*Default*/ | 
|---|
| 148 | #define SELECT_POS_REFERENCE_AIN0                 (0b10 << 2) | 
|---|
| 149 | #define SELECT_POS_REFERENCE_AIN2                 (0b11 << 2) | 
|---|
| 150 |  | 
|---|
| 151 | #define SELECT_NEG_REFERENCE_INTERNAL             (0b00 << 0) | 
|---|
| 152 | #define SELECT_NEG_REFERENCE_AVSS                 (0b01 << 0)/*Default*/ | 
|---|
| 153 | #define SELECT_NEG_REFERENCE_AIN1                 (0b10 << 0) | 
|---|
| 154 | #define SELECT_NEG_REFERENCE_AIN3                 (0b11 << 0) | 
|---|
| 155 |  | 
|---|
| 156 | #define SELECT_REFERENCE_RESET_MASK              ~(0b1111 << 0) | 
|---|
| 157 |  | 
|---|
| 158 | #define OFFSET_CAL_LOW_BYTE_REG                                   (0x07) | 
|---|
| 159 | #define OFFSET_CAL_MID_BYTE_REG                                   (0x08) | 
|---|
| 160 | #define OFFSET_CAL_HIGH_BYTE_REG                                  (0x09) | 
|---|
| 161 |  | 
|---|
| 162 | #define FSCALE_CAL_LOW_BYTE_REG                                   (0x0A) | 
|---|
| 163 | #define FSCALE_CAL_MID_BYTE_REG                                   (0x0B) | 
|---|
| 164 | #define FSCALE_CAL_HIGH_BYTE_REG                                  (0x0C) | 
|---|
| 165 |  | 
|---|
| 166 | #define INPUT_MUX_REGISTER                                        (0x11) | 
|---|
| 167 |  | 
|---|
| 168 | #define POS_INPUT_MUX_SELECT_AINCOM               (0b0000 << 4) | 
|---|
| 169 | #define POS_INPUT_MUX_SELECT_AIN0                 (0b0001 << 4) | 
|---|
| 170 | #define POS_INPUT_MUX_SELECT_AIN1                 (0b0010 << 4) | 
|---|
| 171 | #define POS_INPUT_MUX_SELECT_AIN2                 (0b0011 << 4) | 
|---|
| 172 | #define POS_INPUT_MUX_SELECT_AIN3                 (0b0100 << 4) | 
|---|
| 173 | #define POS_INPUT_MUX_SELECT_AIN4                 (0b0101 << 4) | 
|---|
| 174 | #define POS_INPUT_MUX_SELECT_INT_TEMP_SENSOR_POS  (0b1011 << 4) | 
|---|
| 175 | #define POS_INPUT_MUX_SELECT_INT_AVDD_DIV4_POS    (0b1100 << 4) | 
|---|
| 176 | #define POS_INPUT_MUX_SELECT_INT_DVDD_DIV4_POS    (0b1101 << 4) | 
|---|
| 177 | #define POS_INPUT_MUX_SELECT_INPUTS_OPEN          (0b1110 << 4) | 
|---|
| 178 | #define POS_INPUT_MUX_SELECT_VCOM                 (0b1111 << 4) | 
|---|
| 179 |  | 
|---|
| 180 | #define NEG_INPUT_MUX_SELECT_AINCOM               (0b0000 << 4) | 
|---|
| 181 | #define NEG_INPUT_MUX_SELECT_AIN0                 (0b0001 << 0) | 
|---|
| 182 | #define NEG_INPUT_MUX_SELECT_AIN1                 (0b0010 << 0) | 
|---|
| 183 | #define NEG_INPUT_MUX_SELECT_AIN2                 (0b0011 << 0) | 
|---|
| 184 | #define NEG_INPUT_MUX_SELECT_AIN3                 (0b0100 << 0) | 
|---|
| 185 | #define NEG_INPUT_MUX_SELECT_AIN4                 (0b0101 << 0) | 
|---|
| 186 | #define NEG_INPUT_MUX_SELECT_INT_TEMP_SENSOR_NEG  (0b1011 << 0) | 
|---|
| 187 | #define NEG_INPUT_MUX_SELECT_INT_AVDD_DIV4_NEG    (0b1100 << 0) | 
|---|
| 188 | #define NEG_INPUT_MUX_SELECT_INT_DVDD_DIV4_NEG    (0b1101 << 0) | 
|---|
| 189 | #define NEG_INPUT_MUX_SELECT_INPUTS_OPEN          (0b1110 << 0) | 
|---|
| 190 | #define NEG_INPUT_MUX_SELECT_VCOM                 (0b1111 << 0) | 
|---|
| 191 | #define INPUT_MUX_SELECT_RESET_MASK              ~(0b00000000 << 0) | 
|---|
| 192 |  | 
|---|
| 193 | //      --- LOKALE TYPE DEFS - bitte hier dokumentieren------------------------------- | 
|---|
| 194 |  | 
|---|
| 195 | //      --- DEFINITIONEN GLOBALER VARIABLEN - Bitte in Header dokumentieren ---------- | 
|---|
| 196 | uint32_t ahCounter[50]; | 
|---|
| 197 | int32_t nrOfValuesCurrent; | 
|---|
| 198 | int32_t avgValWithOffsetCompensation; | 
|---|
| 199 | int32_t avgValWithOffsetCommonModeOffsetCorrection; | 
|---|
| 200 | int32_t avgValWithOffsetCommonModeOffsetTemperatureCorrection; | 
|---|
| 201 | double current; | 
|---|
| 202 | double currentWithGainCorrection; | 
|---|
| 203 | double currentWithGainAndGainShuntTempCorrection; | 
|---|
| 204 | //double currentWithGainAndGainShuntTempAndGainChipTempCorrection; | 
|---|
| 205 | //      --- LOKALE VARIABLEN - bitte hier dokumentieren ------------------------------ | 
|---|
| 206 | static adc_state_enum_t ads1260DataCoversionState; | 
|---|
| 207 |  | 
|---|
| 208 | static const uint8_t RREG_BaseOpcode = 0x20;                                                 // Read Register CMD | 
|---|
| 209 | static const uint8_t WREG_BaseOpcode = 0x40;                                                 // Write Register CMD | 
|---|
| 210 | static const uint8_t LOCK_Opcode = 0xF2;                                                     // Lock registers modification CMD | 
|---|
| 211 | static const uint8_t RDATA_Opcode = 0x12;                                                    // Read conversion DATA CMD | 
|---|
| 212 |  | 
|---|
| 213 | static const uint8_t MODE3_regAdr = 0x05;                                                    // MODE3 register address | 
|---|
| 214 | static const uint8_t MODE3_STATENB = 6U;                                                     // Status enable bit position in MODE3 register | 
|---|
| 215 | static const uint8_t MODE3_CRCENB = 5U;                                                      // CRC enable bit position in MODE3 register | 
|---|
| 216 |  | 
|---|
| 217 | static const uint8_t STATUS_regAdr = 0x01; | 
|---|
| 218 | static const uint8_t STATUS_LOCK = 7U; | 
|---|
| 219 | static const uint8_t STATUS_CRCERR = 6U; | 
|---|
| 220 | static const uint8_t STATUS_REFL_ALM = 3U; | 
|---|
| 221 | static const uint8_t STATUS_DRDY = 2U; | 
|---|
| 222 |  | 
|---|
| 223 |  | 
|---|
| 224 | static const uint8_t arbitraryByte = 0xEC;                                                   // Don't care byte | 
|---|
| 225 | static const uint8_t replyHeader = 0xFF; | 
|---|
| 226 |  | 
|---|
| 227 | //      --- LOKALE FUNKTIONS PROTOTYPEN ---------------------------------------------- | 
|---|
| 228 | static void ADS_1260_SetConversionMode(SPI_HandleTypeDef * hspi, uint8_t conversionMode); | 
|---|
| 229 | static void ADS_1260_SetInternalReference(SPI_HandleTypeDef * hspi); | 
|---|
| 230 | static void ADS_1260_SetExternalReference(SPI_HandleTypeDef * hspi); | 
|---|
| 231 | static void ADS_1260_InputMuxSelect(SPI_HandleTypeDef * hspi, uint8_t muxSelect); | 
|---|
| 232 | static void ADS_1260_SetChopMode(SPI_HandleTypeDef * hspi, uint8_t chopMode); | 
|---|
| 233 | static void ADS_1260_ActivateStatusData(void); | 
|---|
| 234 | static void ADS_1260_ActivateLock(void); | 
|---|
| 235 |  | 
|---|
| 236 | static uint32_t ADS1260_ProcessCurrent(int32_t current); | 
|---|
| 237 | volatile uint32_t newCurrentValue=0; | 
|---|
| 238 | //static uint32_t ADS1260_ProcessVoltage(int32_t voltage, sys_data_t * data); | 
|---|
| 239 | //static uint32_t ADS1260_ProcessTemperature(int32_t temperature, sys_data_t * data); | 
|---|
| 240 |  | 
|---|
| 241 | // Funktionen werden extern | 
|---|
| 242 |  | 
|---|
| 243 | //      --- LOKALE FUNKTIONEN - bitte hier dokumentieren ----------------------------- | 
|---|
| 244 |  | 
|---|
| 245 | /* | 
|---|
| 246 | * @brief        Einstellung Conversion Mode | 
|---|
| 247 | * @param        kein | 
|---|
| 248 | * @retval       kein | 
|---|
| 249 | */ | 
|---|
| 250 | static void ADS_1260_SetConversionMode(SPI_HandleTypeDef * hspi, uint8_t conversionMode) | 
|---|
| 251 | { | 
|---|
| 252 | uint8_t spiData[DATA_ARRAY_SIZE]; | 
|---|
| 253 | // Read | 
|---|
| 254 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + CONVERSION_MODE_REGISTER); | 
|---|
| 255 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 256 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, RECEIVE_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 257 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 258 | // Modify | 
|---|
| 259 | spiData[SEND_DATA_POS] = ((spiData[RECEIVE_DATA_POS] & CONVERSION_MODE_RESET_MASK) | conversionMode); // so gefriemelt dass der Conversionsmodus gesetzt wird und der Rest des Registers unberührt beleibt | 
|---|
| 260 | // Write | 
|---|
| 261 | spiData[COMMAND_POS] = (REGISTER_WRITE_COMMAND + CONVERSION_MODE_REGISTER); | 
|---|
| 262 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 263 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, SEND_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 264 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 265 | // Read | 
|---|
| 266 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + CONVERSION_MODE_REGISTER); | 
|---|
| 267 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 268 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, RECEIVE_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 269 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 270 | // Verify | 
|---|
| 271 | if((spiData[RECEIVE_DATA_POS] & conversionMode) != conversionMode) | 
|---|
| 272 | { | 
|---|
| 273 | printf("ERROR ADS_1260_SetConversionMode\n"); | 
|---|
| 274 | while(1); | 
|---|
| 275 | } | 
|---|
| 276 |  | 
|---|
| 277 | } | 
|---|
| 278 |  | 
|---|
| 279 | /* | 
|---|
| 280 | * @brief        Einstellung Chop Mode | 
|---|
| 281 | * @param        kein | 
|---|
| 282 | * @retval       kein | 
|---|
| 283 | */ | 
|---|
| 284 | static void ADS_1260_SetChopMode(SPI_HandleTypeDef * hspi, uint8_t chopMode) | 
|---|
| 285 | { | 
|---|
| 286 | uint8_t spiData[DATA_ARRAY_SIZE]; | 
|---|
| 287 | // Read | 
|---|
| 288 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + CHOP_MODE_REGISTER); | 
|---|
| 289 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 290 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, RECEIVE_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 291 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 292 | // Modify | 
|---|
| 293 | spiData[SEND_DATA_POS] = ((spiData[RECEIVE_DATA_POS] & CHOP_MODE_RESET_MASK) | chopMode); // so gefriemelt dass der Conversionsmodus gesetzt wird und der Rest des Registers unberührt beleibt | 
|---|
| 294 | // Write | 
|---|
| 295 | spiData[COMMAND_POS] = (REGISTER_WRITE_COMMAND + CHOP_MODE_REGISTER); | 
|---|
| 296 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 297 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, SEND_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 298 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 299 | // Read | 
|---|
| 300 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + CHOP_MODE_REGISTER); | 
|---|
| 301 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 302 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, RECEIVE_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 303 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 304 | // Verify | 
|---|
| 305 | if((spiData[RECEIVE_DATA_POS] & chopMode) != chopMode) | 
|---|
| 306 | { | 
|---|
| 307 | printf("ERROR ADS_1260_SetChopMode\n"); | 
|---|
| 308 | while(1); | 
|---|
| 309 | } | 
|---|
| 310 | } | 
|---|
| 311 |  | 
|---|
| 312 | /* | 
|---|
| 313 | * @brief        Einstellung Datarate | 
|---|
| 314 | * @param        kein | 
|---|
| 315 | * @retval       kein | 
|---|
| 316 | */ | 
|---|
| 317 | void ADS_1260_SetDataRate(SPI_HandleTypeDef * hspi, uint8_t dataRate) | 
|---|
| 318 | { | 
|---|
| 319 | uint8_t spiData[DATA_ARRAY_SIZE]; | 
|---|
| 320 | // Read | 
|---|
| 321 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + DATA_RATE_REGISTER); | 
|---|
| 322 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 323 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, RECEIVE_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 324 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 325 | // Modify | 
|---|
| 326 | spiData[SEND_DATA_POS] = ((spiData[RECEIVE_DATA_POS] & DATA_RATE_RESET_MASK) | dataRate); // so gefriemelt dass die Datarate gesetzt wird und der Rest des Registers unberührt beleibt | 
|---|
| 327 | // Write | 
|---|
| 328 | spiData[COMMAND_POS] = (REGISTER_WRITE_COMMAND + DATA_RATE_REGISTER); | 
|---|
| 329 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 330 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, SEND_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 331 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 332 | // Read | 
|---|
| 333 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + DATA_RATE_REGISTER); | 
|---|
| 334 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 335 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, RECEIVE_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 336 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 337 | // Verify | 
|---|
| 338 | if((spiData[RECEIVE_DATA_POS] & dataRate) != dataRate) | 
|---|
| 339 | { | 
|---|
| 340 | printf("ERROR ADS_1260_SetDataRate\n"); | 
|---|
| 341 | while(1); | 
|---|
| 342 | } | 
|---|
| 343 |  | 
|---|
| 344 | } | 
|---|
| 345 |  | 
|---|
| 346 | /* | 
|---|
| 347 | * @brief        Einstellung Filtertyp | 
|---|
| 348 | * @param        kein | 
|---|
| 349 | * @retval       kein | 
|---|
| 350 | */ | 
|---|
| 351 | void ADS_1260_SetDigitalFilter(SPI_HandleTypeDef * hspi, uint8_t digitalFilter) | 
|---|
| 352 | { | 
|---|
| 353 | uint8_t spiData[DATA_ARRAY_SIZE]; | 
|---|
| 354 | // Read | 
|---|
| 355 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + DIGITAL_FILTER_REGISTER); | 
|---|
| 356 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 357 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, RECEIVE_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 358 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 359 | // Modify | 
|---|
| 360 | spiData[SEND_DATA_POS] = ((spiData[RECEIVE_DATA_POS] & FILTER_RESET_MASK) | digitalFilter); // so gefriemelt dass der Filter gesetzt wird und der Rest des Registers unberührt beleibt | 
|---|
| 361 | // Write | 
|---|
| 362 | spiData[COMMAND_POS] = (REGISTER_WRITE_COMMAND + DIGITAL_FILTER_REGISTER); | 
|---|
| 363 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 364 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, SEND_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 365 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 366 | // Read | 
|---|
| 367 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + DIGITAL_FILTER_REGISTER); | 
|---|
| 368 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 369 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, RECEIVE_DATA_NR_OF_BYTES, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 370 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 371 | // Verify | 
|---|
| 372 | if((spiData[RECEIVE_DATA_POS] & digitalFilter) != digitalFilter) | 
|---|
| 373 | { | 
|---|
| 374 | printf("ERROR ADS_1260_SetDigitalFilter\n"); | 
|---|
| 375 | while(1); | 
|---|
| 376 | } | 
|---|
| 377 | } | 
|---|
| 378 |  | 
|---|
| 379 | /* | 
|---|
| 380 | * @brief        schaltet über die Mux die Eingänge auf den ADC | 
|---|
| 381 | * @param        kein | 
|---|
| 382 | * @retval       kein | 
|---|
| 383 | */ | 
|---|
| 384 | static void ADS_1260_InputMuxSelect(SPI_HandleTypeDef * hspi, uint8_t muxSelect) | 
|---|
| 385 | { | 
|---|
| 386 | // Write | 
|---|
| 387 | uint8_t spiData[3] = {(REGISTER_WRITE_COMMAND + INPUT_MUX_REGISTER), muxSelect, 0}; | 
|---|
| 388 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 389 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, 2, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 390 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 391 | // Read | 
|---|
| 392 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + INPUT_MUX_REGISTER); | 
|---|
| 393 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 394 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, 3, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 395 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 396 | // Verifie | 
|---|
| 397 | if(spiData[RECEIVE_DATA_POS] != muxSelect) | 
|---|
| 398 | { | 
|---|
| 399 | printf("ERROR ADS_1260_InputMuxSelect\n"); | 
|---|
| 400 | //    while(1); | 
|---|
| 401 | } | 
|---|
| 402 | } | 
|---|
| 403 |  | 
|---|
| 404 |  | 
|---|
| 405 | /* | 
|---|
| 406 | * @brief        schaltet die interne 2.500 Volt Referenzspannungsquelle ein | 
|---|
| 407 | *               und wählt diese als Referenspannungsquelle aus | 
|---|
| 408 | * @param        kein | 
|---|
| 409 | * @retval       kein | 
|---|
| 410 | */ | 
|---|
| 411 | static void ADS_1260_SetInternalReference(SPI_HandleTypeDef * hspi) | 
|---|
| 412 | { | 
|---|
| 413 | // Write | 
|---|
| 414 | uint8_t spiData[3] = {(REGISTER_WRITE_COMMAND + REFERENCE_CONFIG_REGISTER), (INTERNAL_REFERENCE_ENABLE + SELECT_POS_REFERENCE_INTERNAL + SELECT_NEG_REFERENCE_INTERNAL), 0}; | 
|---|
| 415 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 416 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, 2, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 417 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 418 | // Read | 
|---|
| 419 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + REFERENCE_CONFIG_REGISTER); | 
|---|
| 420 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 421 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, 3, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 422 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 423 | // Verifie | 
|---|
| 424 | if(spiData[RECEIVE_DATA_POS] != (INTERNAL_REFERENCE_ENABLE + SELECT_POS_REFERENCE_INTERNAL + SELECT_NEG_REFERENCE_INTERNAL)) | 
|---|
| 425 | { | 
|---|
| 426 | printf("ERROR ADS_1260_SetInternalReference\n"); | 
|---|
| 427 | while(1); | 
|---|
| 428 | } | 
|---|
| 429 |  | 
|---|
| 430 | } | 
|---|
| 431 |  | 
|---|
| 432 |  | 
|---|
| 433 | /* | 
|---|
| 434 | * @brief        schaltet die interne 2.500 Volt Referenzspannungsquelle ein | 
|---|
| 435 | *               und wählt diese als Referenspannungsquelle aus | 
|---|
| 436 | * @param        kein | 
|---|
| 437 | * @retval       kein | 
|---|
| 438 | */ | 
|---|
| 439 | static void ADS_1260_SetExternalReference(SPI_HandleTypeDef * hspi) | 
|---|
| 440 | { | 
|---|
| 441 | // Write | 
|---|
| 442 | uint8_t spiData[3] = {(REGISTER_WRITE_COMMAND + REFERENCE_CONFIG_REGISTER), (INTERNAL_REFERENCE_DISABLE + SELECT_POS_REFERENCE_AIN0 + SELECT_NEG_REFERENCE_AIN1), 0}; | 
|---|
| 443 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 444 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, 2, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 445 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 446 | // Read | 
|---|
| 447 | spiData[COMMAND_POS] = (REGISTER_READ_COMMAND + REFERENCE_CONFIG_REGISTER); | 
|---|
| 448 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 449 | HAL_SPI_TransmitReceive(hspi, spiData, spiData, 3, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 450 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 451 | // Verifie | 
|---|
| 452 | if(spiData[RECEIVE_DATA_POS] != (INTERNAL_REFERENCE_DISABLE + SELECT_POS_REFERENCE_AIN0 + SELECT_NEG_REFERENCE_AIN1)) | 
|---|
| 453 | { | 
|---|
| 454 | printf("ERROR ADS_1260_SetInternalReference\n"); | 
|---|
| 455 | while(1); | 
|---|
| 456 | } | 
|---|
| 457 |  | 
|---|
| 458 | } | 
|---|
| 459 |  | 
|---|
| 460 |  | 
|---|
| 461 |  | 
|---|
| 462 |  | 
|---|
| 463 |  | 
|---|
| 464 | /************************************************** KAL *****************************************************************/ | 
|---|
| 465 | /* | 
|---|
| 466 | * @brief        Software Offsetkalibrierung für die Strommessung. | 
|---|
| 467 | *               Voraussetzungen: Es darf kein Strom über den Shunt fließen. | 
|---|
| 468 | *                                Warten bis Mittelwertbildung abgeschlossen ist. | 
|---|
| 469 | * @param        kein | 
|---|
| 470 | * @retval       kein | 
|---|
| 471 | */ | 
|---|
| 472 | void ADS_1260_BatteryCurrentOffsetCalibrationStart(sys_data_t * data) | 
|---|
| 473 | { | 
|---|
| 474 | data->s.parameter.batteryCurrentOffset = data->s.values.battryCurrentRaw; | 
|---|
| 475 | data->s.parameter.batteryCurrentOffsetRefTemperatureShunt = data->s.values.shuntTemperature; | 
|---|
| 476 | data->s.parameter.batteryCurrentOffsetRefTemperatureChip = data->s.values.chipTemperature; | 
|---|
| 477 | data->s.parameter.batteryCurrentOffsetRefshuntVoltage = data->s.values.shuntVoltage; | 
|---|
| 478 | EEPROM_storeConfig(&sys_data,0); | 
|---|
| 479 | } | 
|---|
| 480 |  | 
|---|
| 481 | void ADS_1260_BatteryCurrentOffsetCommonModeErrorComepensationStart(sys_data_t * data) | 
|---|
| 482 | { | 
|---|
| 483 | //speichere geänderte CommonMode Spannung | 
|---|
| 484 | data->s.parameter.batteryCurrentOffsetCommonModeCalibrationVoltage = data->s.values.shuntVoltage; | 
|---|
| 485 |  | 
|---|
| 486 | //Delta berechnen | 
|---|
| 487 | //Kompensationswert speichern in ADC Steps *1000 pro mV Common Mode Voltage | 
|---|
| 488 | int32_t deltaU = data->s.parameter.batteryCurrentOffsetCommonModeCalibrationVoltage - data->s.parameter.batteryCurrentOffsetRefshuntVoltage; | 
|---|
| 489 |  | 
|---|
| 490 | //Entstandene Abweichung durch Common Mode Fehler, ist aktueller Messwert mit vorherigen Kompensationen | 
|---|
| 491 | int32_t deltaADC =  avgValWithOffsetCompensation; | 
|---|
| 492 | int32_t compensationFactor = deltaADC * 1000 / deltaU; | 
|---|
| 493 | data->s.parameter.batteryCurrentOffsetCommonModeCompensationFactor = compensationFactor; | 
|---|
| 494 | EEPROM_storeConfig(&sys_data,0); | 
|---|
| 495 | } | 
|---|
| 496 |  | 
|---|
| 497 | void ADS_1260_BatteryCurrentOffsetTemperatureErrorComepensationStart(void) | 
|---|
| 498 | { | 
|---|
| 499 | //speichere geänderte Temperatur | 
|---|
| 500 | //Achtung die Offset Kompeensation machen wir hier absichtlich mit der Chip Temperatur und nicht mit der Shunt Temperatur | 
|---|
| 501 | //Die Chip spiegeelt genaueer die Temperatur der ADC und Strommessverstärker wieder. Der Offset driftt hängt von der Temp der ADC/VREF/Messverstrker zusammen | 
|---|
| 502 | //und nicht mit der Temp der Shunt Widerstände | 
|---|
| 503 | sys_data.s.parameter.batteryCurrentOffsetTemperatureCalibrationTemperature = sys_data.s.values.chipTemperature; | 
|---|
| 504 |  | 
|---|
| 505 |  | 
|---|
| 506 | //Delta berechnen | 
|---|
| 507 | int32_t deltaT = sys_data.s.parameter.batteryCurrentOffsetTemperatureCalibrationTemperature - sys_data.s.parameter.batteryCurrentOffsetRefTemperatureChip; | 
|---|
| 508 | int32_t deltaADC =  avgValWithOffsetCommonModeOffsetCorrection; | 
|---|
| 509 | int32_t compensationFactor = deltaADC * 1000 / deltaT; | 
|---|
| 510 | sys_data.s.parameter.batteryCurrentOffsetTemperatureCompensationFactor = compensationFactor; | 
|---|
| 511 | EEPROM_storeConfig(&sys_data,0); | 
|---|
| 512 | } | 
|---|
| 513 |  | 
|---|
| 514 |  | 
|---|
| 515 |  | 
|---|
| 516 |  | 
|---|
| 517 | void ADS_1260_BatteryCurrentGainCalibrationStart(sys_data_t * data) | 
|---|
| 518 | { | 
|---|
| 519 | double helper; | 
|---|
| 520 | printf("--- Gain  CAL ---"); | 
|---|
| 521 | if(data->s.parameter.batteryCurrentGainRefCurrent == 0) // Fehler | 
|---|
| 522 | { | 
|---|
| 523 | printf("ADS_1260_BatteryCurrentGainCalibrationStart: ERROR IN CALIBRATION, NO REFERENCE CURRENT!\n"); | 
|---|
| 524 | return; | 
|---|
| 525 | } | 
|---|
| 526 |  | 
|---|
| 527 |  | 
|---|
| 528 |  | 
|---|
| 529 | // Sollstrom durch Batteriestrom teilen | 
|---|
| 530 | // Sollstrom ist in mA also umrechen in A, da Batteriestrom ("current") auch in A | 
|---|
| 531 | // ACHTUNG Das Punkt 0 ist wichtig, muss mit Fließkomma Berechnung durchgeführt werden!!!! | 
|---|
| 532 | helper = (data->s.parameter.batteryCurrentGainRefCurrent / 1000.0 ) / current; | 
|---|
| 533 | // in den Batteriegain umrechnen | 
|---|
| 534 | data->s.parameter.batteryCurrentGainCorrectionFaktor = (helper * 1000000.0); | 
|---|
| 535 | // schreibe Temperatur bei der kalibriert wurde | 
|---|
| 536 | data->s.parameter.batteryCurrentGainRefTempShunt = data->s.values.shuntTemperature; | 
|---|
| 537 | data->s.parameter.batteryCurrentGainRefTempChip  = data->s.values.chipTemperature; | 
|---|
| 538 |  | 
|---|
| 539 | printf("I (without compensation)=%f\n", current); | 
|---|
| 540 | printf("I Referenz=%f\n", data->s.parameter.batteryCurrentGainRefCurrent / 1000.0); | 
|---|
| 541 | printf("Tshunt=%f\n", data->s.parameter.batteryCurrentGainRefTempShunt/100.0); | 
|---|
| 542 | printf("Tship=%f\n", data->s.parameter.batteryCurrentGainRefTempChip/100.0); | 
|---|
| 543 | printf("Korrekturfaktor=%f\n", data->s.parameter.batteryCurrentGainCorrectionFaktor*1000000.0 ); | 
|---|
| 544 | printf("--- Gain  CAL ENDE---"); | 
|---|
| 545 | EEPROM_storeConfig(&sys_data,0); | 
|---|
| 546 | } | 
|---|
| 547 | //Self Heat Kompensation | 
|---|
| 548 | void ADS_1260_BatteryCurrentGainTemperatureCalibrationShuntStart(void) | 
|---|
| 549 | { | 
|---|
| 550 | double helper; | 
|---|
| 551 | printf("--- Gain Drift CAL ---"); | 
|---|
| 552 | //speichere aktuelle Temperatur | 
|---|
| 553 | sys_data.s.parameter.batteryCurrentGainTemperatureCalibrationShuntTemperature = sys_data.s.values.shuntTemperature; | 
|---|
| 554 | printf("Actual T=%f C\n", sys_data.s.parameter.batteryCurrentGainTemperatureCalibrationShuntTemperature/100.0); | 
|---|
| 555 | //Temperaturänderung berechnen | 
|---|
| 556 | int32_t deltaTShunt = ( sys_data.s.values.shuntTemperature - sys_data.s.parameter.batteryCurrentGainRefTempShunt); | 
|---|
| 557 | printf("delta T=%f C\n", deltaTShunt/100.0); | 
|---|
| 558 |  | 
|---|
| 559 | helper = currentWithGainCorrection; | 
|---|
| 560 | printf("Acutal I=%f A(without gain temp drift correction)\n", currentWithGainCorrection); | 
|---|
| 561 | printf("Ref I=%f\n", sys_data.s.parameter.batteryCurrentGainRefCurrent/1000.0); | 
|---|
| 562 | // Sollstrom durch Batteriestrom   teilen | 
|---|
| 563 | // wir erhalten den Korrektur Faktor für die aktuelle Temperatur | 
|---|
| 564 | helper = (sys_data.s.parameter.batteryCurrentGainRefCurrent/1000.0) / helper; | 
|---|
| 565 |  | 
|---|
| 566 | // Speichere Korrekturfaktor pro Schritt Temperaturänderung | 
|---|
| 567 | helper = helper - 1.0; | 
|---|
| 568 |  | 
|---|
| 569 | helper = helper / (deltaTShunt); | 
|---|
| 570 |  | 
|---|
| 571 | //Speicher um Faktor 10000000 erhöht um Kommazahlen zu vermeiden | 
|---|
| 572 | sys_data.s.parameter.batteryCurrentGainTemperatureCompensationShuntFactor = helper*1000000000.0; | 
|---|
| 573 |  | 
|---|
| 574 | printf("Korrekturfaktor=%f [ 1 / Celsius]\n", (sys_data.s.parameter.batteryCurrentGainTemperatureCompensationShuntFactor  / 1000000000.0 * 100) + 1.0 ); | 
|---|
| 575 | printf("--- Gain Drift CAL ENDE ---"); | 
|---|
| 576 | EEPROM_storeConfig(&sys_data,0); | 
|---|
| 577 | } | 
|---|
| 578 |  | 
|---|
| 579 | ////Ambient Temperature | 
|---|
| 580 | //void ADS_1260_BatteryCurrentGainTemperatureCalibrationChipStart() | 
|---|
| 581 | //{ | 
|---|
| 582 | //  double helper; | 
|---|
| 583 | //  //speichere geänderte Temperatur | 
|---|
| 584 | //  sys_data.s.parameter.batteryCurrentGainTemperatureCalibrationChipTemperature = sys_data.s.values.chipTemperature; | 
|---|
| 585 | //  int32_t deltaT = sys_data.s.values.chipTemperature - sys_data.s.parameter.batteryCurrentGainRefTempChip; | 
|---|
| 586 | // | 
|---|
| 587 | // | 
|---|
| 588 | //  helper = currentWithGainAndGainShuntTempCorrection; | 
|---|
| 589 | //  // Sollstrom durch Batteriestrom   teilen | 
|---|
| 590 | //  // wir erhalten den Korrektur Faktor für die aktuelle Temperatur | 
|---|
| 591 | //  helper = (sys_data.s.parameter.batteryCurrentGainRefCurrent/1000.0) / helper; | 
|---|
| 592 | // | 
|---|
| 593 | //  // Speichere Korrekturfaktor pro Schritt Temperaturänderung | 
|---|
| 594 | //  helper = helper - 1.0; | 
|---|
| 595 | // | 
|---|
| 596 | //  helper = helper / deltaT; | 
|---|
| 597 | // | 
|---|
| 598 | //  //Speicher um Faktor 10000000 erhöht um Kommazahlen zu vermeiden | 
|---|
| 599 | //  sys_data.s.parameter.batteryCurrentGainTemperatureCompensationChipFactor = helper*1000000000.0; | 
|---|
| 600 | // | 
|---|
| 601 | //} | 
|---|
| 602 |  | 
|---|
| 603 |  | 
|---|
| 604 | /* | 
|---|
| 605 | * @brief        Rohwerte ADC in Strom umrechnen | 
|---|
| 606 | * @param        kein | 
|---|
| 607 | * @retval       kein | 
|---|
| 608 | */ | 
|---|
| 609 |  | 
|---|
| 610 | #define BATTERY_CURRENT_FILTER 2 | 
|---|
| 611 |  | 
|---|
| 612 | static uint32_t ADS1260_ProcessCurrent(int32_t newval) | 
|---|
| 613 | { | 
|---|
| 614 | static signed long avgsum = 0; | 
|---|
| 615 | static int meas_counter; | 
|---|
| 616 | if (meas_counter < INT32_MAX) meas_counter++; | 
|---|
| 617 | int32_t avgval; | 
|---|
| 618 |  | 
|---|
| 619 | // Filterlängen in 2er-Potenzen --> Compiler optimiert | 
|---|
| 620 | avgsum -= avgsum/ BATTERY_CURRENT_FILTER; | 
|---|
| 621 | avgsum += newval; | 
|---|
| 622 | avgval = avgsum / BATTERY_CURRENT_FILTER; | 
|---|
| 623 | sys_data.s.values.battryCurrentRaw = avgval; | 
|---|
| 624 | /**********************Offset Kompensation:*******************************/ | 
|---|
| 625 | // Offset abziehen | 
|---|
| 626 | avgValWithOffsetCompensation = avgval - sys_data.s.parameter.batteryCurrentOffset; | 
|---|
| 627 | // Temperaturabhängiges Offset abziehen | 
|---|
| 628 | // in ADC Messwerten mal Abweichung von Referenttemperatur | 
|---|
| 629 | //current = current - ((sys_data.s.ads1260.s.offsetTemperatureFactorCurrent / 1000.0) * ((sys_data.s.device.parameter.shuntTemperature - sys_data.s.ads1260.s.refTempSoftwareOffsetCalibrationCurrent)/1000.0)); | 
|---|
| 630 | /**********************Offset Kompensation:*******************************/ | 
|---|
| 631 |  | 
|---|
| 632 |  | 
|---|
| 633 | /********************** START Common Mode Kompensation:*******************************/ | 
|---|
| 634 | //Berechne Änderung der aktuellen Spannung am Shunt zu der Spannung am shunt bei Kalibrierung | 
|---|
| 635 | int32_t commonModeDeltaU = ((int32_t)sys_data.s.values.shuntVoltage - (int32_t)sys_data.s.parameter.batteryCurrentOffsetRefshuntVoltage) ; | 
|---|
| 636 | int32_t commonModeErrorAdcSteps = (commonModeDeltaU * sys_data.s.parameter.batteryCurrentOffsetCommonModeCompensationFactor) / 1000.0 ; | 
|---|
| 637 | sys_data.s.values.batteryCurrentOffsetCommonModeCorrectionADCSteps = commonModeErrorAdcSteps; | 
|---|
| 638 | avgValWithOffsetCommonModeOffsetCorrection = avgValWithOffsetCompensation - commonModeErrorAdcSteps; | 
|---|
| 639 | /********************** ENDE Common Mode Kompensation:*******************************/ | 
|---|
| 640 |  | 
|---|
| 641 | /********************** START Offset Temperature Kompensation*******************************/ | 
|---|
| 642 | //Berechne Änderung der aktuellen Spannung am Shunt zu der Spannung am shunt bei Kalibrierung | 
|---|
| 643 | //Achtung wir arbeiten für die Offset Temperatur Kompenssation mit der Chip Temperatur, nicht mit der Shunt Temperatur, vgl Kal. Faunktion | 
|---|
| 644 | double temperatureDeltaT = ((int32_t)sys_data.s.values.chipTemperature - (int32_t) sys_data.s.parameter.batteryCurrentOffsetRefTemperatureChip); | 
|---|
| 645 | int32_t temperatureErrorAdcSteps = (temperatureDeltaT * sys_data.s.parameter.batteryCurrentOffsetTemperatureCompensationFactor) / 1000.0 ; | 
|---|
| 646 | avgValWithOffsetCommonModeOffsetTemperatureCorrection = avgValWithOffsetCommonModeOffsetCorrection - temperatureErrorAdcSteps; | 
|---|
| 647 | /********************** ENDE Offset Temperature Kompensation *******************************/ | 
|---|
| 648 |  | 
|---|
| 649 |  | 
|---|
| 650 |  | 
|---|
| 651 |  | 
|---|
| 652 | // ADC Messwerte nach Mittwelwertbildung und Offset speichern | 
|---|
| 653 | //sys_data.s.ads1260.s.mwADCStepsWithOffsetCorrectionCurrent = current; | 
|---|
| 654 |  | 
|---|
| 655 | // 250 resultiert aus 100µOhm Shunt + (Verstärkung Strommessverstärker = 20) * 2 -> Umrechnung in Strom | 
|---|
| 656 | // 200 resultiert aus 125µOhm Shunt + (Verstärkung Strommessverstärker = 20) * 2 -> Umrechnung in Strom | 
|---|
| 657 | // 2.5 = Vref, externe Referenz ist 3.0V | 
|---|
| 658 | // 0x800000 = ADC Auflösung | 
|---|
| 659 | #if (DEVICETYPE == 500) | 
|---|
| 660 | current = ((avgValWithOffsetCommonModeOffsetTemperatureCorrection * (double)3.0 * 200.0) / (double)0x800000); | 
|---|
| 661 | #elif (DEVICETYPE == 250) | 
|---|
| 662 | current = ((avgValWithOffsetCommonModeOffsetTemperatureCorrection * (double)3.0 * 100.0) / (double)0x800000); | 
|---|
| 663 | #elif (DEVICETYPE == 125) | 
|---|
| 664 | current = ((avgValWithOffsetCommonModeOffsetTemperatureCorrection * (double)3.0 * 50.0) / (double)0x800000); | 
|---|
| 665 | #else | 
|---|
| 666 | #error No valid device type | 
|---|
| 667 | #endif | 
|---|
| 668 | // Gain aus Sysdata | 
|---|
| 669 | currentWithGainCorrection = current * (sys_data.s.parameter.batteryCurrentGainCorrectionFaktor / 1000000.0); | 
|---|
| 670 |  | 
|---|
| 671 | /**********************Gain Temperatur Kompensation:*******************************/ | 
|---|
| 672 | // Wenn sich in Abhängigkeit von der Temperatur das Gain ändert wird der Messwert mit einem Wert 1 +/- einem kleinen Faktor | 
|---|
| 673 | // der abhängig von der Temperaturabweichung ist multipliziert | 
|---|
| 674 | //ausgabe = ausgabe * ( 1 + ((sys_data.s.ads1260.s.gainTemperatureFactorCurrent * ((sys_data.s.device.parameter.shuntTemperature - sys_data.s.ads1260.s.refTempSoftwareGainCalibrationCurrent) / 1000.0) / 1000000000.0))); | 
|---|
| 675 | /**********************Gain Temperatur Kompensation:*******************************/ | 
|---|
| 676 |  | 
|---|
| 677 | #ifdef PRINT_BATTERY_CURRENT | 
|---|
| 678 | // Ausgabe runden auf %f.3 | 
|---|
| 679 | printf("battery current = %.4fA\n", current); | 
|---|
| 680 | #endif | 
|---|
| 681 |  | 
|---|
| 682 |  | 
|---|
| 683 |  | 
|---|
| 684 |  | 
|---|
| 685 | double temperatureDeltaTShunt; | 
|---|
| 686 | //double temperatureDeltaTChip; | 
|---|
| 687 | temperatureDeltaTShunt = ((int32_t)sys_data.s.values.shuntTemperature - (int32_t) sys_data.s.parameter.batteryCurrentGainRefTempShunt); | 
|---|
| 688 | //temperatureDeltaTChip = ((int32_t)sys_data.s.values.chipTemperature - (int32_t) sys_data.s.parameter.batteryCurrentGainRefTempChip); | 
|---|
| 689 |  | 
|---|
| 690 | // Gain Temperaturkompensation anwenden - Shunt | 
|---|
| 691 | double f = (sys_data.s.parameter.batteryCurrentGainTemperatureCompensationShuntFactor / 1000000000.0); | 
|---|
| 692 | double k = 1.0 + (temperatureDeltaTShunt  * f); | 
|---|
| 693 | currentWithGainAndGainShuntTempCorrection = currentWithGainCorrection * k; | 
|---|
| 694 |  | 
|---|
| 695 |  | 
|---|
| 696 | // Gain Temperaturkompensation anwenden - Ambient | 
|---|
| 697 | //double f2 = (sys_data.s.parameter.batteryCurrentGainTemperatureCompensationChipFactor / 1000000000.0); | 
|---|
| 698 | //double k2 = 1.0 + (  temperatureDeltaTChip * f2); | 
|---|
| 699 | //k2=1; //Testabschaltung | 
|---|
| 700 | //currentWithGainAndGainShuntTempAndGainChipTempCorrection = currentWithGainAndGainShuntTempCorrection * k2; | 
|---|
| 701 |  | 
|---|
| 702 |  | 
|---|
| 703 |  | 
|---|
| 704 | // printf("i=%f A. ist=%f, fs=%f, dTs=%f\n", currentWithGainCorrection, currentWithGainAndGainShuntTempCorrection, k,  temperatureDeltaTShunt ); | 
|---|
| 705 |  | 
|---|
| 706 | //Endergebniss in mA speichern | 
|---|
| 707 | #if (DEVICETYPE == 500) | 
|---|
| 708 | if ((currentWithGainAndGainShuntTempCorrection > 550.0) || (currentWithGainAndGainShuntTempCorrection < -550.0)) | 
|---|
| 709 | { | 
|---|
| 710 | sys_data.s.values.batteryCurrent = sys_data.s.values.fast_current; | 
|---|
| 711 | } | 
|---|
| 712 | else | 
|---|
| 713 | { | 
|---|
| 714 | sys_data.s.values.batteryCurrent = currentWithGainAndGainShuntTempCorrection * 1000.0; | 
|---|
| 715 | } | 
|---|
| 716 | #elif (DEVICETYPE == 250) | 
|---|
| 717 | if ((currentWithGainAndGainShuntTempCorrection > 275.0) || (currentWithGainAndGainShuntTempCorrection < -275.0)) | 
|---|
| 718 | { | 
|---|
| 719 | sys_data.s.values.batteryCurrent = sys_data.s.values.fast_current; | 
|---|
| 720 | } | 
|---|
| 721 | else | 
|---|
| 722 | { | 
|---|
| 723 | sys_data.s.values.batteryCurrent = currentWithGainAndGainShuntTempCorrection * 1000.0; | 
|---|
| 724 | } | 
|---|
| 725 | #elif (DEVICETYPE == 125) | 
|---|
| 726 | if ((currentWithGainAndGainShuntTempCorrection > 137.0) || (currentWithGainAndGainShuntTempCorrection < -137.0)) | 
|---|
| 727 | { | 
|---|
| 728 | sys_data.s.values.batteryCurrent = sys_data.s.values.fast_current; | 
|---|
| 729 | } | 
|---|
| 730 | else | 
|---|
| 731 | { | 
|---|
| 732 | sys_data.s.values.batteryCurrent = currentWithGainAndGainShuntTempCorrection * 1000.0; | 
|---|
| 733 | } | 
|---|
| 734 | #else | 
|---|
| 735 | #error No valid device type | 
|---|
| 736 | #endif | 
|---|
| 737 |  | 
|---|
| 738 |  | 
|---|
| 739 |  | 
|---|
| 740 | if (meas_counter > (BATTERY_CURRENT_FILTER *10)) // Nur aktualiseren, wenn es schon ausreichend Messwerte gab | 
|---|
| 741 | { | 
|---|
| 742 | // höchster und niedrigster Stromwert werden gespeichert | 
|---|
| 743 | if(sys_data.s.values.batteryCurrent > sys_data.s.values.batteryCurrentMax) | 
|---|
| 744 | { | 
|---|
| 745 | sys_data.s.values.batteryCurrentMax = sys_data.s.values.batteryCurrent; | 
|---|
| 746 | } | 
|---|
| 747 | if(sys_data.s.values.batteryCurrent < sys_data.s.values.batteryCurrentMin) | 
|---|
| 748 | { | 
|---|
| 749 | sys_data.s.values.batteryCurrentMin = sys_data.s.values.batteryCurrent; | 
|---|
| 750 | } | 
|---|
| 751 | } | 
|---|
| 752 |  | 
|---|
| 753 | newCurrentValue=1; | 
|---|
| 754 |  | 
|---|
| 755 | return 0; | 
|---|
| 756 | } | 
|---|
| 757 |  | 
|---|
| 758 |  | 
|---|
| 759 | //      --- GLOBALE FUNKTIONEN - bitte in Header dokumentieren------------------------ | 
|---|
| 760 |  | 
|---|
| 761 | void ADS1260_init(void) | 
|---|
| 762 | { | 
|---|
| 763 | uint8_t sdata[10] = {0x47,0x00,0x00,0x00,0x00,0x00}; | 
|---|
| 764 | /* 0*/ ads1260DataCoversionState = ADC_STATE_INITIALIZE; | 
|---|
| 765 | /* 3*/ HAL_GPIO_WritePin(ADC_START_CONV_GPIO_Port, ADC_START_CONV_Pin, GPIO_PIN_SET); | 
|---|
| 766 | HAL_Delay(150); // Delay weil die Vref braucht zeit um sich zu stabilisieren (siehe Datenblatt Seite 9) | 
|---|
| 767 | /* 1*/ //HAL_GPIO_WritePin(ADC_POWER_DOWN_GPIO_Port, ADC_POWER_DOWN_Pin, GPIO_PIN_RESET); | 
|---|
| 768 | //HAL_Delay(150); // Delay weil die Vref braucht zeit um sich zu stabilisieren (siehe Datenblatt Seite 9) | 
|---|
| 769 | /* 1*/ //HAL_GPIO_WritePin(ADC_POWER_DOWN_GPIO_Port, ADC_POWER_DOWN_Pin, GPIO_PIN_SET); | 
|---|
| 770 | //HAL_Delay(150); // Delay weil die Vref braucht zeit um sich zu stabilisieren (siehe Datenblatt Seite 9) | 
|---|
| 771 | /* 2*/ HAL_GPIO_WritePin(ADC_RESET_GPIO_Port, ADC_RESET_Pin, GPIO_PIN_RESET); | 
|---|
| 772 | HAL_Delay(150); // Delay weil die Vref braucht zeit um sich zu stabilisieren (siehe Datenblatt Seite 9) | 
|---|
| 773 | /* 2*/ HAL_GPIO_WritePin(ADC_RESET_GPIO_Port, ADC_RESET_Pin, GPIO_PIN_SET); | 
|---|
| 774 | HAL_Delay(150); // Delay weil die Vref braucht zeit um sich zu stabilisieren (siehe Datenblatt Seite 9) | 
|---|
| 775 | /* 3*/ HAL_GPIO_WritePin(ADC_START_CONV_GPIO_Port, ADC_START_CONV_Pin, GPIO_PIN_RESET); | 
|---|
| 776 |  | 
|---|
| 777 | /* 4*/ //while(HAL_GPIO_ReadPin(ADC_DATA_READY_GPIO_Port, ADC_DATA_READY_Pin) == GPIO_PIN_RESET); | 
|---|
| 778 | HAL_NVIC_SetPriority(EXTI4_15_IRQn, 2, 0); | 
|---|
| 779 | HAL_NVIC_EnableIRQ(EXTI4_15_IRQn); | 
|---|
| 780 |  | 
|---|
| 781 | /* 5*/ ADS_1260_SetExternalReference(&hspi1); | 
|---|
| 782 | HAL_Delay(150); | 
|---|
| 783 | /* 6*/ ADS_1260_SetDataRate(&hspi1, DATA_RATE_20); | 
|---|
| 784 | //  /* 7*/ ADS_1260_SetDigitalFilter(&hspi1, FILTER_SINC4); | 
|---|
| 785 | /* 8*/ ADS_1260_SetConversionMode(&hspi1, CONVERSION_MODE_CONTINIOUS); | 
|---|
| 786 | // langsamer | 
|---|
| 787 | ADS_1260_SetChopMode(&hspi1, CHOP_MODE_CHOP_MODE); | 
|---|
| 788 | ADS_1260_InputMuxSelect(&hspi1, POS_INPUT_MUX_SELECT_AIN2 + NEG_INPUT_MUX_SELECT_AIN3); | 
|---|
| 789 |  | 
|---|
| 790 | ADS_1260_ActivateStatusData(); | 
|---|
| 791 | ADS_1260_ActivateLock(); | 
|---|
| 792 |  | 
|---|
| 793 | /*10*/ //ADS_1260_SelfOffsetCalibration(&hspi1); | 
|---|
| 794 | HAL_Delay(150); | 
|---|
| 795 | /*x*/  ads1260DataCoversionState = ADC_STATE_READY_FOR_CONVERSION; | 
|---|
| 796 | ADS1260_StartConversion(); | 
|---|
| 797 | } | 
|---|
| 798 |  | 
|---|
| 799 |  | 
|---|
| 800 | void ADS1260_StartConversion(void) | 
|---|
| 801 | { | 
|---|
| 802 | HAL_GPIO_WritePin(ADC_START_CONV_GPIO_Port, ADC_START_CONV_Pin, GPIO_PIN_SET); | 
|---|
| 803 | } | 
|---|
| 804 |  | 
|---|
| 805 | void ADS1260_ReadConversion(void) | 
|---|
| 806 | { | 
|---|
| 807 | extern CRC_HandleTypeDef hcrc; | 
|---|
| 808 | convert_union_t convert; | 
|---|
| 809 |  | 
|---|
| 810 | //                                                    CRC2 | 
|---|
| 811 | uint8_t spiDataIn[9] = { RDATA_Opcode, arbitraryByte, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; | 
|---|
| 812 | spiDataIn[2] = HAL_CRC_Calculate(&hcrc, (uint32_t*) spiDataIn, 2); | 
|---|
| 813 | uint8_t spiDataOut[9] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; | 
|---|
| 814 |  | 
|---|
| 815 | int32_t value = 0; | 
|---|
| 816 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 817 | HAL_SPI_TransmitReceive(&hspi1, spiDataIn, spiDataOut, 9, DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 818 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 819 |  | 
|---|
| 820 | if (spiDataOut[0] == replyHeader && spiDataOut[1] == spiDataIn[0] && spiDataOut[2] == spiDataIn[1] && spiDataOut[3] == spiDataIn[2] && spiDataOut[8] == HAL_CRC_Calculate(&hcrc, (uint32_t*) &spiDataOut[4], 4)) | 
|---|
| 821 | { | 
|---|
| 822 | uint8_t STATUS_reg = spiDataOut[4]; | 
|---|
| 823 |  | 
|---|
| 824 | if ((STATUS_reg & (1 << STATUS_LOCK)) && (STATUS_reg & (1 << STATUS_DRDY)) && !(STATUS_reg & (1 << STATUS_CRCERR)) && !(STATUS_reg & (1 << STATUS_REFL_ALM))) | 
|---|
| 825 | { | 
|---|
| 826 | // Rohwerte Byteswitch | 
|---|
| 827 | convert.s[3] = 0; | 
|---|
| 828 | convert.s[2] = spiDataOut[5]; | 
|---|
| 829 | convert.s[1] = spiDataOut[6]; | 
|---|
| 830 | convert.s[0] = spiDataOut[7]; | 
|---|
| 831 |  | 
|---|
| 832 | // Vorzeichen ausrechnen (24 bit MSB = Vorzeichenbit muss auf 32 bit umgesetzt werden) | 
|---|
| 833 | if(convert.w >= 0x800000) | 
|---|
| 834 | { | 
|---|
| 835 | convert.sw = -(0xFFFFFF - convert.w); | 
|---|
| 836 | value = convert.sw; | 
|---|
| 837 | } | 
|---|
| 838 | else if(convert.w < 0x800000) | 
|---|
| 839 | { | 
|---|
| 840 | //convert.sw = convert.w; | 
|---|
| 841 | value = convert.w; | 
|---|
| 842 | } | 
|---|
| 843 | } | 
|---|
| 844 | else | 
|---|
| 845 | { | 
|---|
| 846 | sys_data.s.values.adc_restarts++; | 
|---|
| 847 | ADS1260_init(); | 
|---|
| 848 | } | 
|---|
| 849 |  | 
|---|
| 850 | } | 
|---|
| 851 | else | 
|---|
| 852 | { | 
|---|
| 853 | sys_data.s.values.adc_restarts++; | 
|---|
| 854 | ADS1260_init(); | 
|---|
| 855 | } | 
|---|
| 856 |  | 
|---|
| 857 | ADS1260_ProcessCurrent(value); | 
|---|
| 858 | } | 
|---|
| 859 |  | 
|---|
| 860 | //----------------------------------------------------------------------------- | 
|---|
| 861 |  | 
|---|
| 862 | static void ADS_1260_ActivateLock(void) | 
|---|
| 863 | { | 
|---|
| 864 | extern CRC_HandleTypeDef hcrc; | 
|---|
| 865 | const int maxReTries = 5; | 
|---|
| 866 | int lockIsWritten = 0; | 
|---|
| 867 |  | 
|---|
| 868 | for (int i = 0; i < maxReTries; i++) | 
|---|
| 869 | { | 
|---|
| 870 | // Sendin LOCK command                        CRC2 | 
|---|
| 871 | uint8_t Din[] = { LOCK_Opcode, arbitraryByte, 0x00, 0x00 }; | 
|---|
| 872 | Din[2] = HAL_CRC_Calculate(&hcrc, (uint32_t*) Din, 2); | 
|---|
| 873 | uint8_t Dout[] = { 0x00, 0x00, 0x00, 0x00 }; | 
|---|
| 874 |  | 
|---|
| 875 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 876 | HAL_SPI_TransmitReceive(&hspi1, Din, Dout, sizeof(Din) / sizeof(Din[0]), DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 877 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 878 |  | 
|---|
| 879 | if (Dout[0] == replyHeader && Dout[1] == Din[0] && Dout[2] == Din[1] && Dout[3] == Din[2]) | 
|---|
| 880 | { | 
|---|
| 881 | lockIsWritten = 1; | 
|---|
| 882 | break; | 
|---|
| 883 | } | 
|---|
| 884 | else continue; | 
|---|
| 885 | } | 
|---|
| 886 |  | 
|---|
| 887 | if (!lockIsWritten) | 
|---|
| 888 | while (1) | 
|---|
| 889 | {   // Blink the RED LED forever | 
|---|
| 890 | HAL_GPIO_TogglePin(LED_ERROR_GPIO_Port, LED_ERROR_Pin); | 
|---|
| 891 | HAL_Delay(350); | 
|---|
| 892 | } | 
|---|
| 893 |  | 
|---|
| 894 | int lockIsWrittenCorrect = 0; | 
|---|
| 895 | // Reading STATUS register to make sure that LOCK is active | 
|---|
| 896 | for (int i = 0; i < maxReTries; i++) | 
|---|
| 897 | { | 
|---|
| 898 | // Reading the content of the STATUS register                     CRC2 | 
|---|
| 899 | uint8_t Din[] = { RREG_BaseOpcode | STATUS_regAdr, arbitraryByte, 0x00, 0x00, 0x00, 0x00 }; | 
|---|
| 900 | Din[2] = HAL_CRC_Calculate(&hcrc, (uint32_t*) Din, 2); | 
|---|
| 901 | uint8_t Dout[] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; | 
|---|
| 902 |  | 
|---|
| 903 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 904 | HAL_SPI_TransmitReceive(&hspi1, Din, Dout, sizeof(Din) / sizeof(Din[0]), DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 905 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 906 |  | 
|---|
| 907 | if (Dout[0] == replyHeader && Dout[1] == Din[0] && Dout[2] == Din[1] && Dout[3] == Din[2] && Dout[5] == HAL_CRC_Calculate(&hcrc, (uint32_t*)&Dout[4], 1)) | 
|---|
| 908 | { | 
|---|
| 909 | uint8_t STATUS_reg = Dout[4]; | 
|---|
| 910 | if (STATUS_reg & (1U << STATUS_LOCK)) | 
|---|
| 911 | { | 
|---|
| 912 | lockIsWrittenCorrect = 1; | 
|---|
| 913 | break; | 
|---|
| 914 | } | 
|---|
| 915 | } | 
|---|
| 916 | else continue; | 
|---|
| 917 | } | 
|---|
| 918 |  | 
|---|
| 919 | if (!lockIsWrittenCorrect) | 
|---|
| 920 | while (1) | 
|---|
| 921 | {   // Blink the RED LED forever | 
|---|
| 922 | HAL_GPIO_TogglePin(LED_ERROR_GPIO_Port, LED_ERROR_Pin); | 
|---|
| 923 | HAL_Delay(400); | 
|---|
| 924 | } | 
|---|
| 925 |  | 
|---|
| 926 | } | 
|---|
| 927 |  | 
|---|
| 928 | //----------------------------------------------------------------------------- | 
|---|
| 929 |  | 
|---|
| 930 | static void ADS_1260_ActivateStatusData(void) | 
|---|
| 931 | { | 
|---|
| 932 | extern CRC_HandleTypeDef hcrc; | 
|---|
| 933 | const int maxReTries = 5; | 
|---|
| 934 | int mode3IsRead = 0; | 
|---|
| 935 | uint8_t MODE3_Reg; | 
|---|
| 936 |  | 
|---|
| 937 | for (int i = 0; i < maxReTries; i++) | 
|---|
| 938 | { | 
|---|
| 939 | // Reading the content of the MODE3 register | 
|---|
| 940 | uint8_t Din[] = { RREG_BaseOpcode | MODE3_regAdr, arbitraryByte, 0x00 }; | 
|---|
| 941 | uint8_t Dout[] = { 0x00, 0x00, 0x00 }; | 
|---|
| 942 |  | 
|---|
| 943 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 944 | HAL_SPI_TransmitReceive(&hspi1, Din, Dout, sizeof(Din) / sizeof(Din[0]), DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 945 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 946 |  | 
|---|
| 947 | if (Dout[0] == replyHeader && Dout[1] == Din[0]) | 
|---|
| 948 | { | 
|---|
| 949 | MODE3_Reg = Dout[2];    // Saving the content of the MODE3 register | 
|---|
| 950 | mode3IsRead = 1; | 
|---|
| 951 | break; | 
|---|
| 952 | } | 
|---|
| 953 | else continue; | 
|---|
| 954 | } | 
|---|
| 955 |  | 
|---|
| 956 | if (!mode3IsRead) | 
|---|
| 957 | while (1) | 
|---|
| 958 | {   // Blink the RED LED forever | 
|---|
| 959 | HAL_GPIO_TogglePin(LED_ERROR_GPIO_Port, LED_ERROR_Pin); | 
|---|
| 960 | HAL_Delay(200); | 
|---|
| 961 | } | 
|---|
| 962 |  | 
|---|
| 963 | // Setting STATENB and CRCENB bits in MODE3 register | 
|---|
| 964 | MODE3_Reg |= (1U << MODE3_STATENB) | (1U << MODE3_CRCENB); | 
|---|
| 965 |  | 
|---|
| 966 | int mode3IsWritten = 0; | 
|---|
| 967 |  | 
|---|
| 968 | for (int i = 0; i < maxReTries; i++) | 
|---|
| 969 | { | 
|---|
| 970 | // Writing back the content of the MODE3 register | 
|---|
| 971 | uint8_t Din[] = { WREG_BaseOpcode | MODE3_regAdr, MODE3_Reg }; | 
|---|
| 972 | uint8_t Dout[] = { 0x00, 0x00 }; | 
|---|
| 973 |  | 
|---|
| 974 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 975 | HAL_SPI_TransmitReceive(&hspi1, Din, Dout, sizeof(Din) / sizeof(Din[0]), DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 976 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 977 |  | 
|---|
| 978 | if (Dout[0] == replyHeader && Dout[1] == Din[0]) | 
|---|
| 979 | { | 
|---|
| 980 | mode3IsWritten = 1; | 
|---|
| 981 | break; | 
|---|
| 982 | } | 
|---|
| 983 | else continue; | 
|---|
| 984 | } | 
|---|
| 985 |  | 
|---|
| 986 | if (!mode3IsWritten) | 
|---|
| 987 | while (1) | 
|---|
| 988 | {   // Blink the RED LED forever | 
|---|
| 989 | HAL_GPIO_TogglePin(LED_ERROR_GPIO_Port, LED_ERROR_Pin); | 
|---|
| 990 | HAL_Delay(250); | 
|---|
| 991 | } | 
|---|
| 992 |  | 
|---|
| 993 | int mode3IsWrittenCorrect = 0; | 
|---|
| 994 |  | 
|---|
| 995 | // We have activated CRC in every data packet, so we need take it into account | 
|---|
| 996 | for (int i = 0; i < maxReTries; i++) | 
|---|
| 997 | { | 
|---|
| 998 | // Reading one more time the content of the MODE3 register       CRC2 | 
|---|
| 999 | uint8_t Din[] = { RREG_BaseOpcode | MODE3_regAdr, arbitraryByte, 0x00, 0x00, 0x00, 0x00 }; | 
|---|
| 1000 | Din[2] = HAL_CRC_Calculate(&hcrc, (uint32_t*) Din, 2); | 
|---|
| 1001 | uint8_t Dout[] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; | 
|---|
| 1002 |  | 
|---|
| 1003 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_RESET); | 
|---|
| 1004 | HAL_SPI_TransmitReceive(&hspi1, Din, Dout, sizeof(Din) / sizeof(Din[0]), DEFAULT_ADS1260_TRANSMIT_RECEIVE_TIMEOUT); | 
|---|
| 1005 | HAL_GPIO_WritePin(ADC_SPI1_NSS_GPIO_Port, ADC_SPI1_NSS_Pin, GPIO_PIN_SET); | 
|---|
| 1006 |  | 
|---|
| 1007 | if (Dout[0] == replyHeader && Dout[1] == Din[0] && Dout[2] == Din[1] && Dout[3] == Din[2] && Dout[5] == HAL_CRC_Calculate(&hcrc, (uint32_t*)&Dout[4], 1)) | 
|---|
| 1008 | { | 
|---|
| 1009 | if ((Dout[4] & (1U << MODE3_STATENB)) && (Dout[4] & (1U << MODE3_CRCENB))) | 
|---|
| 1010 | { | 
|---|
| 1011 | mode3IsWrittenCorrect = 1; | 
|---|
| 1012 | break; | 
|---|
| 1013 | } | 
|---|
| 1014 | } | 
|---|
| 1015 | else continue; | 
|---|
| 1016 | } | 
|---|
| 1017 |  | 
|---|
| 1018 | if (!mode3IsWrittenCorrect) | 
|---|
| 1019 | while (1) | 
|---|
| 1020 | {   // Blink the RED LED forever | 
|---|
| 1021 | HAL_GPIO_TogglePin(LED_ERROR_GPIO_Port, LED_ERROR_Pin); | 
|---|
| 1022 | HAL_Delay(300); | 
|---|
| 1023 | } | 
|---|
| 1024 | } | 
|---|
| 1025 |  | 
|---|
| 1026 | //----------------------------------------------------------------------------- | 
|---|
| 1027 |  | 
|---|
| 1028 | void ADS1260_ConversionFinished(void) | 
|---|
| 1029 | { | 
|---|
| 1030 | ADS1260_ReadConversion(); | 
|---|
| 1031 | // ADS1260_StartConversion(); | 
|---|
| 1032 | } | 
|---|
| 1033 |  | 
|---|
| 1034 | //----------------------------------------------------------------------------- | 
|---|