554
+ − 1 /**
+ − 2 ******************************************************************************
+ − 3 * @file externalInterface.c
+ − 4 * @author heinrichs weikamp gmbh
+ − 5 * @version V0.0.1
+ − 6 * @date 07-Nov-2020
+ − 7 * @brief Interface functionality to proceed external analog signal via i2c connection
+ − 8 *
+ − 9 @verbatim
+ − 10 ==============================================================================
+ − 11 ##### stm32f4xx_hal_i2c.c modification #####
+ − 12 ==============================================================================
+ − 13 The LTC2942 requires an repeated start condition without stop condition
+ − 14 for data reception.
+ − 15
+ − 16 @endverbatim
+ − 17 ******************************************************************************
+ − 18 * @attention
+ − 19 *
+ − 20 * <h2><center>© COPYRIGHT(c) 2014 heinrichs weikamp</center></h2>
+ − 21 *
+ − 22 ******************************************************************************
+ − 23 */
+ − 24 /* Includes ------------------------------------------------------------------*/
+ − 25
+ − 26 #include <math.h>
714
+ − 27 #include <string.h>
554
+ − 28 #include "i2c.h"
+ − 29 #include "externalInterface.h"
+ − 30 #include "scheduler.h"
662
+ − 31 #include "uart.h"
+ − 32 #include "data_exchange.h"
747
+ − 33 #include "pressure.h"
554
+ − 34
+ − 35 extern SGlobal global;
662
+ − 36 extern UART_HandleTypeDef huart1;
554
+ − 37
+ − 38 #define ADC_ANSWER_LENGTH (5u) /* 3424 will provide addr + 4 data bytes */
+ − 39 #define ADC_TIMEOUT (10u) /* conversion stuck for unknown reason => restart */
+ − 40 #define ADC_REF_VOLTAGE_MV (2048.0f) /* reference voltage of MPC3424*/
+ − 41
+ − 42 #define ADC_START_CONVERSION (0x80)
+ − 43 #define ADC_GAIN_4 (0x02)
+ − 44 #define ADC_GAIN_4_VALUE (4.0f)
+ − 45 #define ADC_GAIN_8 (0x03)
+ − 46 #define ADC_GAIN_8_VALUE (8.0f)
+ − 47 #define ADC_RESOLUTION_16BIT (0x08)
+ − 48 #define ADC_RESOLUTION_16BIT_VALUE (16u)
+ − 49 #define ADC_RESOLUTION_18BIT (0x0C)
+ − 50 #define ADC_RESOLUTION_18BIT_VALUE (18u)
+ − 51
+ − 52 #define ANSWER_CONFBYTE_INDEX (4u)
+ − 53
747
+ − 54 #define LOOKUP_CO2_CORR_TABLE_SCALE (1000u)
+ − 55 #define LOOKUP_CO2_CORR_TABLE_MAX (30000u)
+ − 56
554
+ − 57 static uint8_t activeChannel = 0; /* channel which is in request */
+ − 58 static uint8_t recBuf[ADC_ANSWER_LENGTH];
+ − 59 static uint8_t timeoutCnt = 0;
+ − 60 static uint8_t externalInterfacePresent = 0;
+ − 61
+ − 62 float externalChannel_mV[MAX_ADC_CHANNEL];
662
+ − 63 static uint8_t externalV33_On = 0;
691
+ − 64 static uint8_t externalADC_On = 0;
704
+ − 65 static uint8_t externalUART_Protocol = 0;
662
+ − 66 static uint16_t externalCO2Value;
+ − 67 static uint16_t externalCO2SignalStrength;
+ − 68 static uint16_t externalCO2Status = 0;
554
+ − 69
779
+ − 70 static uint8_t lastSensorDataId = 0;
+ − 71 static SSensorDataDiveO2 sensorDataDiveO2[MAX_ADC_CHANNEL];
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 72 static externalInterfaceAutoDetect_t externalAutoDetect = DETECTION_OFF;
747
+ − 73 static externalInterfaceSensorType SensorMap[EXT_INTERFACE_SENSOR_CNT] ={ SENSOR_OPTIC, SENSOR_OPTIC, SENSOR_OPTIC, SENSOR_NONE, SENSOR_NONE};
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 74 static externalInterfaceSensorType tmpSensorMap[EXT_INTERFACE_SENSOR_CNT];
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 75 static externalInterfaceSensorType MasterSensorMap[EXT_INTERFACE_SENSOR_CNT];
714
+ − 76
747
+ − 77 static float LookupCO2PressureCorrection[LOOKUP_CO2_CORR_TABLE_MAX / LOOKUP_CO2_CORR_TABLE_SCALE]; /* lookup table for pressure compensation values */
+ − 78
554
+ − 79
+ − 80 void externalInterface_Init(void)
+ − 81 {
747
+ − 82 uint16_t index;
+ − 83 uint16_t coeff;
554
+ − 84 activeChannel = 0;
+ − 85 timeoutCnt = 0;
+ − 86 externalInterfacePresent = 0;
+ − 87 if(externalInterface_StartConversion(activeChannel) == HAL_OK)
+ − 88 {
+ − 89 externalInterfacePresent = 1;
+ − 90 global.deviceDataSendToMaster.hw_Info.extADC = 1;
+ − 91 }
559
+ − 92 global.deviceDataSendToMaster.hw_Info.checkADC = 1;
662
+ − 93
747
+ − 94 /* Create a lookup table based on GSS application note AN001: PRESSURE COMPENSATION OF A CO2 SENSOR */
+ − 95 /* The main purpose of the sensor in the dive application is to be a warning indicator */
753
+ − 96 /* => no exact values necessary => a lookup table with 1000ppm scaling should be sufficient */
747
+ − 97 LookupCO2PressureCorrection [0] = -0.0014;
+ − 98 for(index = 1; index < (LOOKUP_CO2_CORR_TABLE_MAX / LOOKUP_CO2_CORR_TABLE_SCALE); index++)
+ − 99 {
+ − 100 coeff = index * LOOKUP_CO2_CORR_TABLE_SCALE;
+ − 101 LookupCO2PressureCorrection[index] = 2.811*pow(10,-38)*pow(coeff,6)- 9.817*pow(10,-32)*pow(coeff,5)+1.304*pow(10,-25)*pow(coeff,4)-8.216*pow(10,-20)*pow(coeff,3)+2.311*pow(10,-14)*pow(coeff,2) - 2.195*pow(10,-9)*coeff - 1.471*pow(10,-3);
+ − 102 }
738
+ − 103 externalInterface_InitDatastruct();
+ − 104 }
+ − 105
+ − 106 void externalInterface_InitDatastruct(void)
+ − 107 {
+ − 108 uint8_t index = 0;
+ − 109 /* init data values */
662
+ − 110 externalV33_On = 0;
+ − 111 externalCO2Value = 0;
+ − 112 externalCO2SignalStrength = 0;
+ − 113 externalCO2Status = 0;
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 114 externalAutoDetect = DETECTION_OFF;
738
+ − 115
+ − 116 for(index = 0; index < MAX_ADC_CHANNEL; index++)
+ − 117 {
+ − 118 externalChannel_mV[index] = 0.0;
+ − 119 }
554
+ − 120 }
+ − 121
+ − 122
+ − 123 uint8_t externalInterface_StartConversion(uint8_t channel)
+ − 124 {
+ − 125 uint8_t retval = 0;
+ − 126 uint8_t confByte = 0;
+ − 127
+ − 128 if(channel < MAX_ADC_CHANNEL)
+ − 129 {
+ − 130 confByte = ADC_START_CONVERSION | ADC_RESOLUTION_16BIT | ADC_GAIN_8;
+ − 131 confByte |= channel << 5;
+ − 132 retval = I2C_Master_Transmit(DEVICE_EXTERNAL_ADC, &confByte, 1);
+ − 133 }
+ − 134 return retval;
+ − 135 }
+ − 136
+ − 137 /* Check if conversion is done and trigger measurement of next channel */
+ − 138 uint8_t externalInterface_ReadAndSwitch()
+ − 139 {
+ − 140 uint8_t retval = EXTERNAL_ADC_NO_DATA;
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 141 uint8_t nextChannel;
731
+ − 142 uint8_t* psensorMap = externalInterface_GetSensorMapPointer(0);
554
+ − 143
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 144 if(externalADC_On)
554
+ − 145 {
+ − 146 if(I2C_Master_Receive(DEVICE_EXTERNAL_ADC, recBuf, ADC_ANSWER_LENGTH) == HAL_OK)
+ − 147 {
+ − 148 if((recBuf[ANSWER_CONFBYTE_INDEX] & ADC_START_CONVERSION) == 0) /* !ready set => received data contains new value */
+ − 149 {
+ − 150 retval = activeChannel; /* return channel number providing new data */
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 151 nextChannel = activeChannel + 1;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 152 if(nextChannel == MAX_ADC_CHANNEL)
554
+ − 153 {
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 154 nextChannel = 0;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 155 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 156
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 157 while((psensorMap[nextChannel] != SENSOR_ANALOG) && (nextChannel != activeChannel))
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 158 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 159 if(nextChannel == MAX_ADC_CHANNEL)
704
+ − 160 {
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 161 nextChannel = 0;
704
+ − 162 }
+ − 163 else
+ − 164 {
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 165 nextChannel++;
704
+ − 166 }
554
+ − 167 }
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 168
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 169 activeChannel = nextChannel;
554
+ − 170 externalInterface_StartConversion(activeChannel);
+ − 171 timeoutCnt = 0;
+ − 172 }
+ − 173 else
+ − 174 {
+ − 175 if(timeoutCnt++ >= ADC_TIMEOUT)
+ − 176 {
+ − 177 externalInterface_StartConversion(activeChannel);
+ − 178 timeoutCnt = 0;
+ − 179 }
+ − 180 }
+ − 181 }
581
+ − 182 else /* take also i2c bus disturb into account */
+ − 183 {
+ − 184 if(timeoutCnt++ >= ADC_TIMEOUT)
+ − 185 {
+ − 186 externalInterface_StartConversion(activeChannel);
+ − 187 timeoutCnt = 0;
+ − 188 }
+ − 189 }
554
+ − 190 }
+ − 191 return retval;
+ − 192 }
+ − 193 float externalInterface_CalculateADCValue(uint8_t channel)
+ − 194 {
+ − 195 int32_t rawvalue = 0;
+ − 196 float retValue = 0.0;
+ − 197 if(channel < MAX_ADC_CHANNEL)
+ − 198 {
+ − 199
+ − 200 rawvalue = ((recBuf[0] << 16) | (recBuf[1] << 8) | (recBuf[2]));
+ − 201
+ − 202 switch(recBuf[3] & 0x0C) /* confbyte => Resolution bits*/
+ − 203 {
+ − 204 case ADC_RESOLUTION_16BIT: rawvalue = rawvalue >> 8; /* only 2 databytes received shift out confbyte*/
+ − 205 if(rawvalue & (0x1 << (ADC_RESOLUTION_16BIT_VALUE-1))) /* MSB set => negative number */
+ − 206 {
+ − 207 rawvalue |= 0xFFFF0000; /* set MSB for int32 */
+ − 208 }
+ − 209 else
+ − 210 {
+ − 211 rawvalue &= 0x0000FFFF;
+ − 212 }
+ − 213 externalChannel_mV[channel] = ADC_REF_VOLTAGE_MV * 2.0 / (float) pow(2,ADC_RESOLUTION_16BIT_VALUE); /* calculate bit resolution */
+ − 214 break;
+ − 215 case ADC_RESOLUTION_18BIT: if(rawvalue & (0x1 << (ADC_RESOLUTION_18BIT_VALUE-1))) /* MSB set => negative number */
+ − 216 {
+ − 217 rawvalue |= 0xFFFE0000; /* set MSB for int32 */
+ − 218 }
+ − 219 externalChannel_mV[channel] = ADC_REF_VOLTAGE_MV * 2.0 / (float) pow(2,ADC_RESOLUTION_18BIT_VALUE); /* calculate bit resolution */
+ − 220 break;
+ − 221 default: rawvalue = 0;
+ − 222 break;
+ − 223 }
+ − 224 externalChannel_mV[channel] = externalChannel_mV[channel] * rawvalue / ADC_GAIN_8_VALUE;
+ − 225 retValue = externalChannel_mV[channel];
+ − 226 }
+ − 227 return retValue;
+ − 228 }
+ − 229 float getExternalInterfaceChannel(uint8_t channel)
+ − 230 {
+ − 231 float retval = 0;
+ − 232
+ − 233 if(channel < MAX_ADC_CHANNEL)
+ − 234 {
+ − 235 retval = externalChannel_mV[channel];
+ − 236 }
+ − 237 return retval;
+ − 238 }
662
+ − 239
691
+ − 240 uint8_t setExternalInterfaceChannel(uint8_t channel, float value)
+ − 241 {
+ − 242 uint8_t retval = 0;
+ − 243
+ − 244 if(channel < MAX_ADC_CHANNEL)
+ − 245 {
+ − 246 externalChannel_mV[channel] = value;
+ − 247 retval = 1;
+ − 248 }
+ − 249 return retval;
+ − 250 }
+ − 251
662
+ − 252 void externalInterface_InitPower33(void)
+ − 253 {
+ − 254 GPIO_InitTypeDef GPIO_InitStructure;
+ − 255
+ − 256 GPIO_InitStructure.Pin = GPIO_PIN_7;
+ − 257 GPIO_InitStructure.Mode = GPIO_MODE_OUTPUT_PP;
+ − 258 GPIO_InitStructure.Pull = GPIO_PULLUP;
+ − 259 GPIO_InitStructure.Speed = GPIO_SPEED_LOW;
+ − 260 HAL_GPIO_Init(GPIOC, &GPIO_InitStructure);
+ − 261 HAL_GPIO_WritePin(GPIOC,GPIO_PIN_7,GPIO_PIN_SET);
+ − 262 }
+ − 263
+ − 264
+ − 265 uint8_t externalInterface_isEnabledPower33()
+ − 266 {
+ − 267 return externalV33_On;
+ − 268 }
691
+ − 269
+ − 270 uint8_t externalInterface_isEnabledADC()
+ − 271 {
+ − 272 return externalADC_On;
+ − 273 }
+ − 274
704
+ − 275 uint8_t externalInterface_GetUARTProtocol()
+ − 276 {
+ − 277 return externalUART_Protocol;
+ − 278 }
+ − 279
662
+ − 280 void externalInterface_SwitchPower33(uint8_t state)
+ − 281 {
+ − 282 if(state != externalV33_On)
+ − 283 {
+ − 284 if(state)
+ − 285 {
+ − 286 HAL_GPIO_WritePin(GPIOC,GPIO_PIN_7,GPIO_PIN_RESET);
+ − 287 externalV33_On = 1;
+ − 288 }
+ − 289 else
+ − 290 {
731
+ − 291 if(externalAutoDetect == DETECTION_OFF)
+ − 292 {
+ − 293 HAL_GPIO_WritePin(GPIOC,GPIO_PIN_7,GPIO_PIN_SET);
+ − 294 externalV33_On = 0;
+ − 295 externalInterface_SetCO2Value(0);
+ − 296 externalInterface_SetCO2SignalStrength(0);
+ − 297 }
662
+ − 298 }
+ − 299 }
+ − 300 }
691
+ − 301 void externalInterface_SwitchADC(uint8_t state)
+ − 302 {
714
+ − 303 uint8_t loop = 0;
691
+ − 304 if((state) && (externalInterfacePresent))
+ − 305 {
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 306 if(externalADC_On == 0)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 307 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 308 activeChannel = 0;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 309 externalInterface_StartConversion(activeChannel);
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 310 externalADC_On = 1;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 311 }
691
+ − 312 }
+ − 313 else
+ − 314 {
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 315 if(externalAutoDetect == DETECTION_OFF) /* block deactivation requests if auto detection is active */
714
+ − 316 {
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 317 externalADC_On = 0;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 318 for(loop = 0; loop < MAX_ADC_CHANNEL; loop++)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 319 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 320 externalChannel_mV[loop] = 0;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 321 }
714
+ − 322 }
691
+ − 323 }
+ − 324 }
662
+ − 325
704
+ − 326 void externalInterface_SwitchUART(uint8_t protocol)
+ − 327 {
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 328 switch(protocol)
704
+ − 329 {
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 330 case 0:
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 331 case (EXT_INTERFACE_UART_CO2 >> 8):
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 332 case (EXT_INTERFACE_UART_O2 >> 8):
742
+ − 333 case (EXT_INTERFACE_UART_SENTINEL >> 8):
779
+ − 334 if((externalAutoDetect <= DETECTION_START)
+ − 335 || ((protocol == EXT_INTERFACE_UART_O2 >> 8) && (externalAutoDetect == DETECTION_DIGO2_0))
+ − 336 || ((protocol == EXT_INTERFACE_UART_O2 >> 8) && (externalAutoDetect == DETECTION_DIGO2_1))
+ − 337 || ((protocol == EXT_INTERFACE_UART_O2 >> 8) && (externalAutoDetect == DETECTION_DIGO2_2))
781
+ − 338 || ((protocol == EXT_INTERFACE_UART_O2 >> 8) && (externalAutoDetect == DETECTION_DIGO2_3))
779
+ − 339 || ((protocol == EXT_INTERFACE_UART_O2 >> 8) && (externalAutoDetect == DETECTION_UARTMUX))
746
+ − 340 #ifdef ENABLE_CO2_SUPPORT
+ − 341 || ((protocol == EXT_INTERFACE_UART_CO2 >> 8) && (externalAutoDetect == DETECTION_CO2))
+ − 342 #endif
+ − 343 #ifdef ENABLE_SENTINEL_MODE
+ − 344 || ((protocol == EXT_INTERFACE_UART_SENTINEL >> 8) && (externalAutoDetect == DETECTION_SENTINEL))
+ − 345 #endif
+ − 346 )
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 347 {
779
+ − 348 lastSensorDataId = 0;
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 349 externalUART_Protocol = protocol;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 350 MX_USART1_UART_DeInit();
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 351 if( protocol != 0)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 352 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 353 MX_USART1_UART_Init();
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 354 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 355 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 356 break;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 357 default:
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 358 break;
704
+ − 359 }
+ − 360 }
+ − 361
662
+ − 362 void externalInterface_SetCO2Value(uint16_t CO2_ppm)
+ − 363 {
747
+ − 364 float local_ppm = CO2_ppm * 10.0; /* scalfactor */
+ − 365
+ − 366 #ifndef ENABLE_EXTERNAL_PRESSURE
+ − 367 float local_corr = 0.0;
+ − 368
+ − 369 if (local_ppm >= LOOKUP_CO2_CORR_TABLE_MAX)
+ − 370 {
+ − 371 local_corr = -0.0014;
+ − 372 }
+ − 373 else
+ − 374 {
+ − 375 local_corr = LookupCO2PressureCorrection[((uint16_t) (local_ppm / LOOKUP_CO2_CORR_TABLE_SCALE))];
+ − 376 }
+ − 377 local_ppm = local_ppm / (1.0 + (local_corr * (get_surface_mbar() - get_pressure_mbar())));
+ − 378 #else
+ − 379 /* The external pressure value is passed via ADC channel2 and calibration is done at firmware => just forward sensor data */
+ − 380 /* compensation is done at firmware side. This is for testing only. Take care the the same algorithm is taken as used for the lookup table */
+ − 381 #endif
+ − 382 externalCO2Value = local_ppm / 10.0;
662
+ − 383 }
+ − 384
+ − 385 void externalInterface_SetCO2SignalStrength(uint16_t LED_qa)
+ − 386 {
+ − 387 externalCO2SignalStrength = LED_qa;
+ − 388 }
+ − 389
+ − 390 uint16_t externalInterface_GetCO2Value(void)
+ − 391 {
+ − 392 return externalCO2Value;
+ − 393 }
+ − 394
+ − 395 uint16_t externalInterface_GetCO2SignalStrength(void)
+ − 396 {
+ − 397 return externalCO2SignalStrength;
+ − 398 }
+ − 399
+ − 400
+ − 401 void externalInterface_SetCO2State(uint16_t state)
+ − 402 {
+ − 403 externalCO2Status = state;
+ − 404 }
+ − 405
+ − 406 uint16_t externalInterface_GetCO2State(void)
+ − 407 {
+ − 408 return externalCO2Status;
+ − 409 }
+ − 410
714
+ − 411
779
+ − 412 uint8_t externalInterface_GetSensorData(uint8_t sensorId, uint8_t* pDataStruct)
714
+ − 413 {
779
+ − 414 uint8_t localId = sensorId;
786
+ − 415 if(localId == 0xFF)
779
+ − 416 {
+ − 417 localId = lastSensorDataId;
+ − 418 }
714
+ − 419
786
+ − 420 if((pDataStruct != NULL) && (localId <= MAX_ADC_CHANNEL))
714
+ − 421 {
786
+ − 422 memcpy(pDataStruct, &sensorDataDiveO2[localId], sizeof(SSensorDataDiveO2));
+ − 423 }
+ − 424 else
+ − 425 {
+ − 426 localId = 0xFF;
714
+ − 427 }
779
+ − 428 return localId;
714
+ − 429 }
+ − 430
786
+ − 431 void externalInterface_SetSensorData(uint8_t sensorId, uint8_t* pDataStruct)
714
+ − 432 {
+ − 433 if(pDataStruct != NULL)
+ − 434 {
786
+ − 435 if((sensorId != 0xFF) && (sensorId < MAX_ADC_CHANNEL))
714
+ − 436 {
786
+ − 437 memcpy(&sensorDataDiveO2[sensorId], pDataStruct, sizeof(SSensorDataDiveO2));
+ − 438 lastSensorDataId = sensorId;
714
+ − 439 }
+ − 440 else
+ − 441 {
+ − 442 memset(&sensorDataDiveO2,0,sizeof(sensorDataDiveO2));
786
+ − 443 lastSensorDataId = 0xFF;
714
+ − 444 }
+ − 445 }
+ − 446 }
+ − 447
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 448 void externalInface_SetSensorMap(uint8_t* pMap)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 449 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 450 if(pMap != NULL)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 451 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 452 memcpy(MasterSensorMap, pMap, 5); /* the map is not directly copied. Copy is done via cmd request */
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 453 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 454
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 455 }
731
+ − 456 uint8_t* externalInterface_GetSensorMapPointer(uint8_t finalMap)
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 457 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 458 uint8_t* pret;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 459
731
+ − 460 if((externalAutoDetect != DETECTION_OFF) && (!finalMap))
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 461 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 462 pret = tmpSensorMap;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 463 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 464 else
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 465 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 466 pret = SensorMap;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 467 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 468 return pret;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 469 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 470
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 471 void externalInterface_AutodetectSensor()
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 472 {
781
+ − 473 static uint8_t tmpMuxMapping[MAX_MUX_CHANNEL];
779
+ − 474 static uint8_t sensorIndex = 0;
+ − 475 static uint8_t uartMuxChannel = 0;
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 476 uint8_t index = 0;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 477
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 478 if(externalAutoDetect != DETECTION_OFF)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 479 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 480 switch(externalAutoDetect)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 481 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 482 case DETECTION_INIT: sensorIndex = 0;
779
+ − 483 uartMuxChannel = 0;
731
+ − 484 tmpSensorMap[0] = SENSOR_OPTIC;
+ − 485 tmpSensorMap[1] = SENSOR_OPTIC;
+ − 486 tmpSensorMap[2] = SENSOR_OPTIC;
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 487 tmpSensorMap[3] = SENSOR_NONE;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 488 tmpSensorMap[4] = SENSOR_NONE;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 489
779
+ − 490 for(index = 0; index < MAX_ADC_CHANNEL; index++)
+ − 491 {
+ − 492 UART_MapDigO2_Channel(index,index); /* request all addresses */
+ − 493 tmpMuxMapping[index] = 0xff;
+ − 494 }
784
+ − 495 UART_MapDigO2_Channel(2,3);
781
+ − 496
731
+ − 497 if(externalInterfacePresent)
+ − 498 {
+ − 499 externalInterface_SwitchPower33(0);
+ − 500 externalInterface_SwitchUART(0);
+ − 501 for(index = 0; index < MAX_ADC_CHANNEL; index++)
+ − 502 {
+ − 503 externalChannel_mV[index] = 0;
+ − 504 }
+ − 505 externalAutoDetect = DETECTION_START;
+ − 506 }
+ − 507 else
+ − 508 {
+ − 509 externalAutoDetect = DETECTION_DONE; /* without external interface O2 values may only be received via optical port => return default sensor map */
+ − 510 }
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 511 break;
731
+ − 512 case DETECTION_START: tmpSensorMap[0] = SENSOR_ANALOG;
+ − 513 tmpSensorMap[1] = SENSOR_ANALOG;
+ − 514 tmpSensorMap[2] = SENSOR_ANALOG;
+ − 515 externalInterface_SwitchPower33(1);
+ − 516 externalInterface_SwitchADC(1);
+ − 517 externalAutoDetect = DETECTION_ANALOG1;
+ − 518 break;
+ − 519 case DETECTION_ANALOG1: externalAutoDetect = DETECTION_ANALOG2; /* do a second loop to make sure all adc channels could be processed */
+ − 520 break;
+ − 521 case DETECTION_ANALOG2: for(index = 0; index < MAX_ADC_CHANNEL; index++)
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 522 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 523 if(externalChannel_mV[index] > MIN_ADC_VOLTAGE_MV)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 524 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 525 tmpSensorMap[sensorIndex++] = SENSOR_ANALOG;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 526 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 527 else
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 528 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 529 tmpSensorMap[sensorIndex++] = SENSOR_NONE;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 530 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 531 }
779
+ − 532 externalAutoDetect = DETECTION_UARTMUX;
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 533 externalInterface_SwitchUART(EXT_INTERFACE_UART_O2 >> 8);
781
+ − 534 UART_SetDigO2_Channel(MAX_MUX_CHANNEL);
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 535 break;
779
+ − 536 case DETECTION_UARTMUX: if(UART_isDigO2Connected())
+ − 537 {
+ − 538 uartMuxChannel = 1;
+ − 539 }
+ − 540 externalAutoDetect = DETECTION_DIGO2_0;
+ − 541 externalInterface_SwitchUART(EXT_INTERFACE_UART_O2 >> 8);
+ − 542 UART_SetDigO2_Channel(0);
+ − 543
+ − 544 break;
+ − 545 case DETECTION_DIGO2_0:
+ − 546 case DETECTION_DIGO2_1:
781
+ − 547 case DETECTION_DIGO2_2:
+ − 548 case DETECTION_DIGO2_3:
+ − 549 if(UART_isDigO2Connected())
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 550 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 551 for(index = 0; index < 3; index++) /* lookup a channel which may be used by digO2 */
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 552 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 553 if(tmpSensorMap[index] == SENSOR_NONE)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 554 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 555 break;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 556 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 557 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 558 if(index == 3)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 559 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 560 tmpSensorMap[2] = SENSOR_DIGO2; /* digital sensor overwrites ADC */
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 561 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 562 else
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 563 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 564 tmpSensorMap[index] = SENSOR_DIGO2;
781
+ − 565 tmpMuxMapping[externalAutoDetect - DETECTION_DIGO2_0] = index;
784
+ − 566 if(externalAutoDetect == DETECTION_DIGO2_2 ) /* special handling needed because channel is used twice during mux detection */
+ − 567 {
+ − 568 UART_MapDigO2_Channel(0xff, externalAutoDetect - DETECTION_DIGO2_0);
+ − 569 }
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 570 }
781
+ − 571 }
+ − 572 else
+ − 573 {
+ − 574 UART_MapDigO2_Channel(0xff, externalAutoDetect - DETECTION_DIGO2_0);
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 575 }
779
+ − 576 if(uartMuxChannel)
+ − 577 {
+ − 578 externalInterface_SwitchUART(EXT_INTERFACE_UART_O2 >> 8);
+ − 579 UART_SetDigO2_Channel(uartMuxChannel);
784
+ − 580 if(uartMuxChannel < MAX_ADC_CHANNEL - 1)
+ − 581 {
+ − 582 uartMuxChannel++;
+ − 583 }
779
+ − 584 }
+ − 585 else
+ − 586 {
781
+ − 587 externalAutoDetect = DETECTION_DIGO2_3; /* skip detection of other serial sensors */
779
+ − 588 }
742
+ − 589 externalAutoDetect++;
+ − 590 #ifdef ENABLE_CO2_SUPPORT
779
+ − 591 if(externalAutoDetect == DETECTION_CO2)
+ − 592 {
+ − 593 externalInterface_SwitchUART(EXT_INTERFACE_UART_CO2 >> 8);
+ − 594 }
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 595 break;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 596 case DETECTION_CO2: if(UART_isCO2Connected())
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 597 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 598 for(index = 0; index < 3; index++) /* lookup a channel which may be used by CO2*/
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 599 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 600 if(tmpSensorMap[index] == SENSOR_NONE)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 601 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 602 break;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 603 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 604 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 605 if(index == 3)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 606 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 607 tmpSensorMap[sensorIndex++] = SENSOR_CO2; /* place Co2 sensor behind O2 sensors (not visible) */
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 608 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 609 else
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 610 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 611 tmpSensorMap[index] = SENSOR_CO2;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 612 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 613
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 614 }
742
+ − 615 externalAutoDetect++;
+ − 616 #endif
+ − 617 #ifdef ENABLE_SENTINEL_MODE
779
+ − 618 if(externalAutoDetect == DETECTION_SENTINEL)
+ − 619 {
+ − 620 externalInterface_SwitchUART(EXT_INTERFACE_UART_SENTINEL >> 8);
+ − 621 UART_StartDMA_Receiption();
+ − 622 }
742
+ − 623 break;
+ − 624
+ − 625 case DETECTION_SENTINEL:
+ − 626 case DETECTION_SENTINEL2:
+ − 627 if(UART_isSentinelConnected())
+ − 628 {
+ − 629 for(index = 0; index < 3; index++) /* Sentinel is occupiing all sensor slots */
+ − 630 {
+ − 631 tmpSensorMap[index] = SENSOR_SENTINEL;
+ − 632 }
+ − 633 sensorIndex = 3;
+ − 634 }
+ − 635 externalAutoDetect++;
+ − 636 #endif
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 637 break;
779
+ − 638 case DETECTION_DONE: if(uartMuxChannel)
731
+ − 639 {
779
+ − 640 tmpSensorMap[EXT_INTERFACE_SENSOR_CNT-1] = SENSOR_MUX;
731
+ − 641 }
784
+ − 642
781
+ − 643 for(index = 0; index < MAX_MUX_CHANNEL; index++)
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 644 {
784
+ − 645 UART_MapDigO2_Channel(tmpMuxMapping[index], index);
731
+ − 646 }
784
+ − 647
779
+ − 648 externalAutoDetect = DETECTION_OFF;
+ − 649 externalInterface_SwitchUART(0);
786
+ − 650
+ − 651
+ − 652 for(index = 0; index < MAX_ADC_CHANNEL; index++)
+ − 653 {
+ − 654 if(tmpSensorMap[index] == SENSOR_DIGO2) /* set Channel to first valid entry */
+ − 655 {
+ − 656 UART_SetDigO2_Channel(index);
+ − 657 break;
+ − 658 }
+ − 659 }
784
+ − 660 for(index = 0; index < MAX_ADC_CHANNEL; index++)
+ − 661 {
+ − 662 if(tmpSensorMap[index] != SENSOR_NONE)
+ − 663 {
+ − 664 break;
+ − 665 }
+ − 666 }
+ − 667
+ − 668 if(index == MAX_ADC_CHANNEL) /* return default sensor map if no sensor at all has been detected */
+ − 669 {
+ − 670 tmpSensorMap[0] = SENSOR_OPTIC;
+ − 671 tmpSensorMap[1] = SENSOR_OPTIC;
+ − 672 tmpSensorMap[2] = SENSOR_OPTIC;
+ − 673 }
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 674 memcpy(SensorMap, tmpSensorMap, sizeof(tmpSensorMap));
779
+ − 675
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 676 break;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 677 default:
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 678 break;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 679 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 680 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 681 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 682
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 683
662
+ − 684 void externalInterface_ExecuteCmd(uint16_t Cmd)
+ − 685 {
+ − 686 char cmdString[10];
+ − 687 uint8_t cmdLength = 0;
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 688 uint8_t index;
662
+ − 689
+ − 690 switch(Cmd & 0x00FF) /* lower byte is reserved for commands */
+ − 691 {
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 692 case EXT_INTERFACE_AUTODETECT: externalAutoDetect = DETECTION_INIT;
742
+ − 693 for(index = 0; index < 3; index++)
+ − 694 {
+ − 695 SensorMap[index] = SENSOR_SEARCH;
+ − 696 }
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 697 break;
662
+ − 698 case EXT_INTERFACE_CO2_CALIB: cmdLength = snprintf(cmdString, 10, "G\r\n");
+ − 699 break;
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 700 case EXT_INTERFACE_COPY_SENSORMAP: if(externalAutoDetect == DETECTION_OFF)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 701 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 702 memcpy(SensorMap, MasterSensorMap, 5);
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 703 for(index = 0; index < 3; index++)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 704 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 705 if(SensorMap[index] == SENSOR_DIGO2)
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 706 {
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 707 break;
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 708 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 709 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 710 }
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
diff
changeset
+ − 711 break;
662
+ − 712 default:
+ − 713 break;
+ − 714 }
+ − 715 if(cmdLength != 0)
+ − 716 {
+ − 717 HAL_UART_Transmit(&huart1,(uint8_t*)cmdString,cmdLength,10);
+ − 718 }
+ − 719 return;
+ − 720 }
+ − 721