Mercurial > public > ostc4
annotate Small_CPU/Src/uart.c @ 758:b6d8a6fbf4fd
- Colours for scrubber display when time remaining falls below a threshold value
- Display negative values when time is up and diving continues;
- count down remaining scrubber time only when the dive computer is not set to bailout - after all, there is not much point in counting down time if the diver is not breathing through the scrubber.
| author | heinrichsweikamp |
|---|---|
| date | Wed, 15 Mar 2023 09:18:07 +0100 |
| parents | df0d43da1614 |
| children | 0b5f45448eb6 |
| rev | line source |
|---|---|
| 38 | 1 /** |
| 2 ****************************************************************************** | |
| 3 * @file uart.c | |
| 4 * @author heinrichs weikamp gmbh | |
| 5 * @version V0.0.1 | |
| 6 * @date 27-March-2014 | |
| 7 * @brief button control | |
| 8 * | |
| 9 @verbatim | |
| 10 ============================================================================== | |
| 11 ##### How to use ##### | |
| 12 ============================================================================== | |
| 13 @endverbatim | |
| 14 ****************************************************************************** | |
| 15 * @attention | |
| 16 * | |
| 17 * <h2><center>© COPYRIGHT(c) 2015 heinrichs weikamp</center></h2> | |
| 18 * | |
| 19 ****************************************************************************** | |
| 20 */ | |
| 21 /* Includes ------------------------------------------------------------------*/ | |
| 22 #include "uart.h" | |
| 662 | 23 #include "externalInterface.h" |
| 24 #include "data_exchange.h" | |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
25 #include <string.h> /* memset */ |
| 38 | 26 |
| 27 /* Private variables ---------------------------------------------------------*/ | |
| 28 | |
| 721 | 29 #define CHUNK_SIZE (25u) /* the DMA will handle chunk size transfers */ |
| 30 #define CHUNKS_PER_BUFFER (5u) | |
| 662 | 31 UART_HandleTypeDef huart1; |
| 32 | |
| 33 DMA_HandleTypeDef hdma_usart1_rx; | |
| 38 | 34 |
| 662 | 35 uint8_t rxBuffer[CHUNK_SIZE * CHUNKS_PER_BUFFER]; /* The complete buffer has a X * chunk size to allow fariations in buffer read time */ |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
36 static uint8_t rxWriteIndex; /* Index of the data item which is analysed */ |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
37 static uint8_t rxReadIndex; /* Index at which new data is stared */ |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
38 static uint8_t lastCmdIndex; /* Index of last command which has not been completly received */ |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
39 static uint8_t dmaActive; /* Indicator if DMA reception needs to be started */ |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
40 static uint8_t digO2Connected = 0; /* Binary indicator if a sensor is connected or not */ |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
41 static uint8_t CO2Connected = 0; /* Binary indicator if a sensor is connected or not */ |
| 742 | 42 static uint8_t SentinelConnected = 0; /* Binary indicator if a sensor is connected or not */ |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
43 static uint8_t ppO2TargetChannel = 0; /* The OSTC4 supports three slots for visualization of the ppo2. This one is reserved for the digital sensor */ |
| 38 | 44 |
|
714
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
45 static SSensorDataDiveO2 sensorDataDiveO2; /* intermediate storage for additional sensor data */ |
|
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
46 |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
47 char tmpRxBuf[30]; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
48 uint8_t tmpRxIdx = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
49 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
50 static uartO2Status_t Comstatus_O2 = UART_O2_INIT; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
51 |
| 662 | 52 float LED_Level = 0.0; /* Normalized LED value which may be used as indication for the health status of the sensor */ |
| 53 float LED_ZeroOffset = 0.0; | |
| 54 float pCO2 = 0.0; | |
| 38 | 55 /* Exported functions --------------------------------------------------------*/ |
| 56 | |
| 662 | 57 void MX_USART1_UART_Init(void) |
| 38 | 58 { |
| 662 | 59 /* regular init */ |
| 60 | |
| 61 huart1.Instance = USART1; | |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
62 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
63 if(externalInterface_GetUARTProtocol() == 0x04) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
64 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
65 huart1.Init.BaudRate = 19200; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
66 Comstatus_O2 = UART_O2_INIT; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
67 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
68 else |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
69 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
70 huart1.Init.BaudRate = 9600; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
71 } |
| 662 | 72 huart1.Init.WordLength = UART_WORDLENGTH_8B; |
| 73 huart1.Init.StopBits = UART_STOPBITS_1; | |
| 74 huart1.Init.Parity = UART_PARITY_NONE; | |
| 75 huart1.Init.Mode = UART_MODE_TX_RX; | |
| 76 huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE; | |
| 77 huart1.Init.OverSampling = UART_OVERSAMPLING_16; | |
| 78 | |
| 79 HAL_UART_Init(&huart1); | |
| 80 | |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
81 MX_USART1_DMA_Init(); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
82 |
| 731 | 83 memset(rxBuffer,0,sizeof(rxBuffer)); |
| 662 | 84 rxReadIndex = 0; |
| 85 lastCmdIndex = 0; | |
| 86 rxWriteIndex = 0; | |
| 87 dmaActive = 0; | |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
88 digO2Connected = 0; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
89 CO2Connected = 0; |
| 742 | 90 SentinelConnected = 0; |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
91 Comstatus_O2 = UART_O2_INIT; |
| 662 | 92 } |
| 38 | 93 |
| 662 | 94 void MX_USART1_UART_DeInit(void) |
| 95 { | |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
96 HAL_DMA_Abort(&hdma_usart1_rx); |
| 662 | 97 HAL_DMA_DeInit(&hdma_usart1_rx); |
| 98 HAL_UART_DeInit(&huart1); | |
| 99 } | |
| 100 | |
| 101 void MX_USART1_DMA_Init() | |
| 102 { | |
| 103 /* DMA controller clock enable */ | |
| 104 __DMA2_CLK_ENABLE(); | |
| 105 | |
| 106 /* Peripheral DMA init*/ | |
| 107 hdma_usart1_rx.Instance = DMA2_Stream5; | |
| 108 hdma_usart1_rx.Init.Channel = DMA_CHANNEL_4; | |
| 109 hdma_usart1_rx.Init.Direction = DMA_PERIPH_TO_MEMORY; //DMA_MEMORY_TO_PERIPH; | |
| 110 hdma_usart1_rx.Init.PeriphInc = DMA_PINC_DISABLE; | |
| 111 hdma_usart1_rx.Init.MemInc = DMA_MINC_ENABLE; | |
| 112 hdma_usart1_rx.Init.PeriphDataAlignment = DMA_MDATAALIGN_BYTE; | |
| 113 hdma_usart1_rx.Init.MemDataAlignment = DMA_MDATAALIGN_BYTE; | |
| 114 hdma_usart1_rx.Init.Mode = DMA_NORMAL; | |
| 115 hdma_usart1_rx.Init.Priority = DMA_PRIORITY_LOW; | |
| 116 hdma_usart1_rx.Init.FIFOMode = DMA_FIFOMODE_DISABLE; | |
| 117 HAL_DMA_Init(&hdma_usart1_rx); | |
| 118 | |
| 119 __HAL_LINKDMA(&huart1,hdmarx,hdma_usart1_rx); | |
| 120 | |
| 121 /* DMA interrupt init */ | |
| 122 HAL_NVIC_SetPriority(DMA2_Stream5_IRQn, 0, 0); | |
| 123 HAL_NVIC_EnableIRQ(DMA2_Stream5_IRQn); | |
| 38 | 124 } |
| 125 | |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
126 |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
127 void DigitalO2_SetupCmd(uint8_t O2State, uint8_t *cmdString, uint8_t *cmdLength) |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
128 { |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
129 switch (O2State) |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
130 { |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
131 case UART_O2_CHECK: *cmdLength = snprintf((char*)cmdString, 10, "#LOGO"); |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
132 break; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
133 case UART_O2_REQ_INFO: *cmdLength = snprintf((char*)cmdString, 10, "#VERS"); |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
134 break; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
135 case UART_O2_REQ_ID: *cmdLength = snprintf((char*)cmdString, 10, "#IDNR"); |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
136 break; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
137 case UART_O2_REQ_O2: *cmdLength = snprintf((char*)cmdString, 10, "#DOXY"); |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
138 break; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
139 case UART_O2_REQ_RAW: *cmdLength = snprintf((char*)cmdString, 10, "#DRAW"); |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
140 break; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
141 default: *cmdLength = 0; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
142 break; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
143 } |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
144 if(*cmdLength != 0) |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
145 { |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
146 cmdString[*cmdLength] = 0x0D; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
147 *cmdLength = *cmdLength + 1; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
148 } |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
149 } |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
150 |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
151 void StringToInt(char *pstr, uint32_t *puInt32) |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
152 { |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
153 uint8_t index = 0; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
154 uint32_t result = 0; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
155 while((pstr[index] >= '0') && (pstr[index] <= '9')) |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
156 { |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
157 result *=10; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
158 result += pstr[index] - '0'; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
159 index++; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
160 } |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
161 *puInt32 = result; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
162 } |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
163 |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
164 void StringToUInt64(char *pstr, uint64_t *puint64) |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
165 { |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
166 uint8_t index = 0; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
167 uint64_t result = 0; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
168 while((pstr[index] >= '0') && (pstr[index] <= '9')) |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
169 { |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
170 result *=10; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
171 result += pstr[index] - '0'; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
172 index++; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
173 } |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
174 *puint64 = result; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
175 } |
| 690 | 176 void ConvertByteToHexString(uint8_t byte, char* str) |
| 177 { | |
| 178 uint8_t worker = 0; | |
| 179 uint8_t digit = 0; | |
| 180 uint8_t digitCnt = 1; | |
| 38 | 181 |
| 690 | 182 worker = byte; |
| 183 while((worker!=0) && (digitCnt != 255)) | |
| 184 { | |
| 185 digit = worker % 16; | |
| 186 if( digit < 10) | |
| 187 { | |
| 188 digit += '0'; | |
| 189 } | |
| 190 else | |
| 191 { | |
| 192 digit += 'A' - 10; | |
| 193 } | |
| 194 str[digitCnt--]= digit; | |
| 195 worker = worker / 16; | |
| 196 } | |
| 197 } | |
| 662 | 198 |
| 742 | 199 void UART_StartDMA_Receiption() |
| 200 { | |
| 201 if(HAL_OK == HAL_UART_Receive_DMA (&huart1, &rxBuffer[rxWriteIndex], CHUNK_SIZE)) | |
| 202 { | |
| 203 dmaActive = 1; | |
| 204 } | |
| 205 } | |
| 690 | 206 |
| 207 #ifdef ENABLE_CO2_SUPPORT | |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
208 void UART_HandleCO2Data(void) |
| 38 | 209 { |
| 662 | 210 uint8_t localRX = rxReadIndex; |
|
747
df0d43da1614
Added pressure compensation to CO2 detection:
Ideenmodellierer
parents:
742
diff
changeset
|
211 static uint8_t dataType = 0; |
|
df0d43da1614
Added pressure compensation to CO2 detection:
Ideenmodellierer
parents:
742
diff
changeset
|
212 static uint32_t dataValue = 0; |
| 662 | 213 static receiveState_t rxState = RX_Ready; |
| 214 static uint32_t lastReceiveTick = 0; | |
| 215 | |
| 725 | 216 |
| 217 while((rxBuffer[localRX]!=0)) | |
| 662 | 218 { |
| 219 lastReceiveTick = HAL_GetTick(); | |
| 220 if(rxState == RX_Ready) /* identify data content */ | |
| 221 { | |
| 222 switch(rxBuffer[localRX]) | |
| 223 { | |
| 224 case 'l': | |
| 225 case 'D': | |
| 226 case 'Z': | |
| 227 dataType = rxBuffer[localRX]; | |
| 228 rxState = RX_Data0; | |
| 229 dataValue = 0; | |
| 230 break; | |
| 231 | |
| 232 default: /* unknown or corrupted => ignore */ | |
| 233 break; | |
| 234 } | |
| 235 } | |
| 725 | 236 else if((rxBuffer[localRX] >= '0') && (rxBuffer[localRX] <= '9')) |
| 662 | 237 { |
| 725 | 238 if((rxState >= RX_Data0) && (rxState <= RX_Data4)) |
| 662 | 239 { |
| 240 dataValue = dataValue * 10 + (rxBuffer[localRX] - '0'); | |
| 241 rxState++; | |
| 725 | 242 if(rxState == RX_Data5) |
| 243 { | |
| 244 rxState = RX_DataComplete; | |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
245 CO2Connected = 1; |
| 725 | 246 } |
| 247 } | |
| 248 else /* protocol error data has max 5 digits */ | |
| 249 { | |
| 250 rxState = RX_Ready; | |
| 662 | 251 } |
| 252 } | |
| 253 if((rxBuffer[localRX] == ' ') || (rxBuffer[localRX] == '\n')) /* Abort data detection */ | |
| 254 { | |
| 255 if(rxState == RX_DataComplete) | |
| 256 { | |
| 257 if(externalInterface_GetCO2State() == 0) | |
| 258 { | |
| 259 externalInterface_SetCO2State(EXT_INTERFACE_33V_ON); | |
| 260 } | |
| 261 switch(dataType) | |
| 262 { | |
| 263 case 'D': externalInterface_SetCO2SignalStrength(dataValue); | |
| 264 break; | |
| 265 case 'l': LED_ZeroOffset = dataValue; | |
| 266 break; | |
| 267 case 'Z': externalInterface_SetCO2Value(dataValue); | |
| 268 break; | |
|
747
df0d43da1614
Added pressure compensation to CO2 detection:
Ideenmodellierer
parents:
742
diff
changeset
|
269 default: rxState = RX_Ready; |
|
df0d43da1614
Added pressure compensation to CO2 detection:
Ideenmodellierer
parents:
742
diff
changeset
|
270 break; |
| 662 | 271 } |
| 272 } | |
| 273 if(rxState != RX_Data0) /* reset state machine because message in wrong format */ | |
| 274 { | |
| 275 rxState = RX_Ready; | |
| 276 } | |
| 277 } | |
| 742 | 278 rxBuffer[localRX] = 0; |
| 662 | 279 localRX++; |
| 280 rxReadIndex++; | |
| 281 if(rxReadIndex >= CHUNK_SIZE * CHUNKS_PER_BUFFER) | |
| 282 { | |
| 283 localRX = 0; | |
| 284 rxReadIndex = 0; | |
| 285 } | |
| 286 } | |
| 287 | |
| 288 if(time_elapsed_ms(lastReceiveTick,HAL_GetTick()) > 2000) /* check for communication timeout */ | |
| 289 { | |
| 290 externalInterface_SetCO2State(0); | |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
291 CO2Connected = 0; |
| 662 | 292 } |
| 293 | |
| 294 if((dmaActive == 0) && (externalInterface_isEnabledPower33())) /* Should never happen in normal operation => restart in case of communication error */ | |
| 295 { | |
| 742 | 296 UART_StartDMA_Receiption(); |
| 662 | 297 } |
| 38 | 298 } |
| 690 | 299 #endif |
| 300 | |
| 301 #ifdef ENABLE_SENTINEL_MODE | |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
302 void UART_HandleSentinelData(void) |
| 690 | 303 { |
| 304 uint8_t localRX = rxReadIndex; | |
| 305 static uint8_t dataType = 0; | |
| 306 static uint32_t dataValue[3]; | |
| 307 static uint8_t dataValueIdx = 0; | |
| 308 static receiveState_t rxState = RX_Ready; | |
| 309 static uint32_t lastReceiveTick = 0; | |
| 310 static uint8_t lastAlive = 0; | |
| 311 static uint8_t curAlive = 0; | |
| 312 static uint8_t checksum = 0; | |
| 742 | 313 static char checksum_str[]="00"; |
| 690 | 314 |
| 742 | 315 while((rxBuffer[localRX]!=0)) |
| 690 | 316 { |
| 317 lastReceiveTick = HAL_GetTick(); | |
| 318 | |
| 319 switch(rxState) | |
| 320 { | |
| 321 case RX_Ready: if((rxBuffer[localRX] >= 'a') && (rxBuffer[localRX] <= 'z')) | |
| 322 { | |
| 323 rxState = RX_DetectStart; | |
| 324 curAlive = rxBuffer[localRX]; | |
| 325 checksum = 0; | |
| 326 } | |
| 327 break; | |
| 328 | |
| 329 case RX_DetectStart: checksum += rxBuffer[localRX]; | |
| 330 if(rxBuffer[localRX] == '1') | |
| 331 { | |
| 332 rxState = RX_SelectData; | |
| 333 dataType = 0xFF; | |
| 334 | |
| 335 } | |
| 336 else | |
| 337 { | |
| 338 rxState = RX_Ready; | |
| 339 } | |
| 340 break; | |
| 341 | |
| 342 case RX_SelectData: checksum += rxBuffer[localRX]; | |
| 343 switch(rxBuffer[localRX]) | |
| 344 { | |
| 345 case 'T': dataType = rxBuffer[localRX]; | |
| 346 break; | |
| 347 case '0': if(dataType != 0xff) | |
| 348 { | |
| 349 rxState = RX_Data0; | |
| 350 dataValueIdx = 0; | |
| 351 dataValue[0] = 0; | |
| 352 | |
| 353 } | |
| 354 else | |
| 355 { | |
| 356 rxState = RX_Ready; | |
| 357 } | |
| 358 break; | |
| 359 default: rxState = RX_Ready; | |
| 360 } | |
| 361 break; | |
| 362 | |
| 363 case RX_Data0: | |
| 364 case RX_Data1: | |
| 365 case RX_Data2: | |
| 366 case RX_Data4: | |
| 367 case RX_Data5: | |
| 368 case RX_Data6: | |
| 369 case RX_Data8: | |
| 370 case RX_Data9: | |
| 371 case RX_Data10: checksum += rxBuffer[localRX]; | |
| 372 if((rxBuffer[localRX] >= '0') && (rxBuffer[localRX] <= '9')) | |
| 373 { | |
| 374 dataValue[dataValueIdx] = dataValue[dataValueIdx] * 10 + (rxBuffer[localRX] - '0'); | |
| 375 rxState++; | |
| 376 } | |
| 377 else | |
| 378 { | |
| 379 rxState = RX_Ready; | |
| 380 } | |
| 381 break; | |
| 382 | |
| 383 case RX_Data3: | |
| 384 case RX_Data7: checksum += rxBuffer[localRX]; | |
| 385 if(rxBuffer[localRX] == '0') | |
| 386 { | |
| 387 rxState++; | |
| 388 dataValueIdx++; | |
| 389 dataValue[dataValueIdx] = 0; | |
| 390 } | |
| 391 else | |
| 392 { | |
| 393 rxState = RX_Ready; | |
| 394 } | |
| 395 break; | |
| 396 case RX_Data11: rxState = RX_DataComplete; | |
| 397 ConvertByteToHexString(checksum,checksum_str); | |
| 398 if(rxBuffer[localRX] == checksum_str[0]) | |
| 399 { | |
| 400 rxState = RX_DataComplete; | |
| 401 } | |
| 402 else | |
| 403 { | |
| 404 rxState = RX_Ready; | |
| 405 } | |
| 406 | |
| 407 break; | |
| 408 | |
| 409 case RX_DataComplete: if(rxBuffer[localRX] == checksum_str[1]) | |
| 410 { | |
| 411 setExternalInterfaceChannel(0,(float)(dataValue[0] / 10.0)); | |
| 412 setExternalInterfaceChannel(1,(float)(dataValue[1] / 10.0)); | |
| 413 setExternalInterfaceChannel(2,(float)(dataValue[2] / 10.0)); | |
| 742 | 414 SentinelConnected = 1; |
| 690 | 415 } |
| 416 rxState = RX_Ready; | |
| 417 break; | |
| 418 | |
| 419 | |
| 420 default: rxState = RX_Ready; | |
| 421 break; | |
| 422 | |
| 423 } | |
| 424 localRX++; | |
| 425 rxReadIndex++; | |
| 426 if(rxReadIndex >= CHUNK_SIZE * CHUNKS_PER_BUFFER) | |
| 427 { | |
| 428 localRX = 0; | |
| 429 rxReadIndex = 0; | |
| 430 } | |
| 431 } | |
| 432 | |
| 433 if(time_elapsed_ms(lastReceiveTick,HAL_GetTick()) > 4000) /* check for communication timeout */ | |
| 434 { | |
| 435 if(curAlive == lastAlive) | |
| 436 { | |
| 437 setExternalInterfaceChannel(0,0.0); | |
| 438 setExternalInterfaceChannel(1,0.0); | |
| 439 setExternalInterfaceChannel(2,0.0); | |
| 742 | 440 SentinelConnected = 0; |
| 690 | 441 } |
| 442 lastAlive = curAlive; | |
| 443 } | |
| 444 | |
| 445 if((dmaActive == 0) && (externalInterface_isEnabledPower33())) /* Should never happen in normal operation => restart in case of communication error */ | |
| 446 { | |
| 742 | 447 UART_StartDMA_Receiption(); |
| 690 | 448 } |
| 449 } | |
| 450 #endif | |
| 38 | 451 |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
452 |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
453 |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
454 void UART_HandleDigitalO2(void) |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
455 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
456 static uint32_t lastO2ReqTick = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
457 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
458 static uartO2RxState_t rxState = O2RX_IDLE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
459 static uint32_t lastReceiveTick = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
460 static uint8_t lastAlive = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
461 static uint8_t curAlive = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
462 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
463 static uint8_t cmdLength = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
464 static uint8_t cmdString[10]; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
465 static uint8_t cmdReadIndex = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
466 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
467 uint32_t tmpO2 = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
468 uint32_t tmpData = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
469 uint8_t localRX = rxReadIndex; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
470 uint32_t tick = HAL_GetTick(); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
471 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
472 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
473 if(Comstatus_O2 == UART_O2_INIT) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
474 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
475 memset((char*)&rxBuffer[rxWriteIndex],(int)0,CHUNK_SIZE); |
|
714
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
476 memset((char*) &sensorDataDiveO2, 0, sizeof(sensorDataDiveO2)); |
|
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
477 externalInterface_SetSensorData(0,(uint8_t*)&sensorDataDiveO2); |
|
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
478 |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
479 lastAlive = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
480 curAlive = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
481 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
482 Comstatus_O2 = UART_O2_CHECK; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
483 DigitalO2_SetupCmd(Comstatus_O2,cmdString,&cmdLength); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
484 HAL_UART_Transmit(&huart1,cmdString,cmdLength,10); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
485 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
486 rxState = O2RX_CONFIRM; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
487 cmdReadIndex = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
488 lastO2ReqTick = tick; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
489 |
| 742 | 490 UART_StartDMA_Receiption(); |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
491 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
492 if(time_elapsed_ms(lastO2ReqTick,tick) > 1000) /* repeat request once per second */ |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
493 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
494 lastO2ReqTick = tick; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
495 if(Comstatus_O2 == UART_O2_IDLE) /* cyclic request of o2 value */ |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
496 { |
| 721 | 497 Comstatus_O2 = UART_O2_REQ_RAW; |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
498 rxState = O2RX_CONFIRM; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
499 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
500 DigitalO2_SetupCmd(Comstatus_O2,cmdString,&cmdLength); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
501 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
502 HAL_UART_Transmit(&huart1,cmdString,cmdLength,10); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
503 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
504 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
505 while((rxBuffer[localRX]!=0)) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
506 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
507 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
508 lastReceiveTick = tick; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
509 switch(rxState) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
510 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
511 case O2RX_CONFIRM: if(rxBuffer[localRX] == '#') |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
512 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
513 cmdReadIndex = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
514 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
515 if(rxBuffer[localRX] == cmdString[cmdReadIndex]) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
516 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
517 cmdReadIndex++; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
518 if(cmdReadIndex == cmdLength - 1) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
519 { |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
520 digO2Connected = 1; |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
521 tmpRxIdx = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
522 memset((char*) tmpRxBuf, 0, sizeof(tmpRxBuf)); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
523 switch (Comstatus_O2) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
524 { |
|
714
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
525 case UART_O2_CHECK: Comstatus_O2 = UART_O2_REQ_ID; |
|
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
526 rxState = O2RX_CONFIRM; |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
527 DigitalO2_SetupCmd(Comstatus_O2,cmdString,&cmdLength); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
528 HAL_UART_Transmit(&huart1,cmdString,cmdLength,10); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
529 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
530 case UART_O2_REQ_ID: rxState = O2RX_GETNR; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
531 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
532 case UART_O2_REQ_INFO: rxState = O2RX_GETTYPE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
533 break; |
| 721 | 534 case UART_O2_REQ_RAW: |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
535 case UART_O2_REQ_O2: rxState = O2RX_GETO2; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
536 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
537 default: Comstatus_O2 = UART_O2_IDLE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
538 rxState = O2RX_IDLE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
539 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
540 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
541 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
542 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
543 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
544 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
545 case O2RX_GETSTATUS: |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
546 case O2RX_GETTEMP: |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
547 case O2RX_GETTYPE: |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
548 case O2RX_GETVERSION: |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
549 case O2RX_GETCHANNEL: |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
550 case O2RX_GETSUBSENSORS: |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
551 case O2RX_GETO2: |
| 721 | 552 case O2RX_GETNR: |
| 553 case O2RX_GETDPHI: | |
| 554 case O2RX_INTENSITY: | |
| 555 case O2RX_AMBIENTLIGHT: | |
| 556 case O2RX_PRESSURE: | |
| 557 case O2RX_HUMIDITY: | |
| 558 if(rxBuffer[localRX] != 0x0D) | |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
559 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
560 if(rxBuffer[localRX] != ' ') |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
561 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
562 tmpRxBuf[tmpRxIdx++] = rxBuffer[localRX]; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
563 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
564 else |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
565 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
566 if(tmpRxIdx != 0) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
567 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
568 switch(rxState) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
569 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
570 case O2RX_GETCHANNEL: StringToInt(tmpRxBuf,&tmpData); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
571 rxState = O2RX_GETVERSION; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
572 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
573 case O2RX_GETVERSION: StringToInt(tmpRxBuf,&tmpData); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
574 rxState = O2RX_GETSUBSENSORS; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
575 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
576 case O2RX_GETTYPE: StringToInt(tmpRxBuf,&tmpData); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
577 rxState = O2RX_GETCHANNEL; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
578 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
579 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
580 case O2RX_GETO2: StringToInt(tmpRxBuf,&tmpO2); |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
581 setExternalInterfaceChannel(ppO2TargetChannel,(float)(tmpO2 / 10000.0)); |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
582 rxState = O2RX_GETTEMP; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
583 break; |
|
714
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
584 case O2RX_GETTEMP: StringToInt(tmpRxBuf,(uint32_t*)&sensorDataDiveO2.temperature); |
|
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
585 rxState = O2RX_GETSTATUS; |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
586 break; |
| 721 | 587 case O2RX_GETSTATUS: StringToInt(tmpRxBuf,&sensorDataDiveO2.status); /* raw data cycle */ |
| 588 rxState = O2RX_GETDPHI; | |
| 589 break; | |
| 590 case O2RX_GETDPHI: /* ignored to save memory and most likly irrelevant for diver */ | |
| 591 rxState = O2RX_INTENSITY; | |
| 592 break; | |
| 593 case O2RX_INTENSITY: StringToInt(tmpRxBuf,(uint32_t*)&sensorDataDiveO2.intensity); /* raw data cycle */ | |
| 594 rxState = O2RX_AMBIENTLIGHT; | |
| 595 break; | |
| 596 case O2RX_AMBIENTLIGHT: StringToInt(tmpRxBuf,(uint32_t*)&sensorDataDiveO2.ambient); /* raw data cycle */ | |
| 597 rxState = O2RX_PRESSURE; | |
| 598 break; | |
| 599 case O2RX_PRESSURE: StringToInt(tmpRxBuf,(uint32_t*)&sensorDataDiveO2.pressure); /* raw data cycle */ | |
| 600 rxState = O2RX_HUMIDITY; | |
| 601 break; | |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
602 default: |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
603 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
604 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
605 memset((char*) tmpRxBuf, 0, tmpRxIdx); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
606 tmpRxIdx = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
607 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
608 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
609 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
610 else |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
611 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
612 switch (rxState) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
613 { |
|
714
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
614 case O2RX_GETSTATUS: StringToInt(tmpRxBuf,&sensorDataDiveO2.status); |
|
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
615 externalInterface_SetSensorData(1,(uint8_t*)&sensorDataDiveO2); |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
616 Comstatus_O2 = UART_O2_IDLE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
617 rxState = O2RX_IDLE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
618 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
619 case O2RX_GETSUBSENSORS: StringToInt(tmpRxBuf,&tmpData); |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
620 Comstatus_O2 = UART_O2_IDLE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
621 rxState = O2RX_IDLE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
622 break; |
| 721 | 623 case O2RX_HUMIDITY: StringToInt(tmpRxBuf,(uint32_t*)&sensorDataDiveO2.humidity); /* raw data cycle */ |
| 624 externalInterface_SetSensorData(1,(uint8_t*)&sensorDataDiveO2); | |
| 625 Comstatus_O2 = UART_O2_IDLE; | |
| 626 rxState = O2RX_IDLE; | |
| 627 break; | |
|
714
045ff7800501
Added customizable data area for specific sensor data:
Ideenmodellierer
parents:
704
diff
changeset
|
628 case O2RX_GETNR: StringToUInt64((char*)tmpRxBuf,&sensorDataDiveO2.sensorId); |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
629 /* no break */ |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
630 default: Comstatus_O2 = UART_O2_IDLE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
631 rxState = O2RX_IDLE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
632 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
633 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
634 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
635 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
636 default: rxState = O2RX_IDLE; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
637 break; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
638 |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
639 } |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
640 rxBuffer[localRX] = 0; |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
641 localRX++; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
642 rxReadIndex++; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
643 if(rxReadIndex >= CHUNK_SIZE * CHUNKS_PER_BUFFER) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
644 { |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
645 localRX = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
646 rxReadIndex = 0; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
647 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
648 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
649 |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
650 if((digO2Connected) && time_elapsed_ms(lastReceiveTick,HAL_GetTick()) > 4000) /* check for communication timeout */ |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
651 { |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
652 digO2Connected = 0; |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
653 if(curAlive == lastAlive) |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
654 { |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
655 setExternalInterfaceChannel(ppO2TargetChannel,0.0); |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
656 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
657 lastAlive = curAlive; |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
658 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
659 if((dmaActive == 0) && (externalInterface_isEnabledPower33())) /* Should never happen in normal operation => restart in case of communication error */ |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
660 { |
| 742 | 661 UART_StartDMA_Receiption(); |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
662 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
663 } |
|
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
664 |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
665 uint8_t UART_isDigO2Connected() |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
666 { |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
667 return digO2Connected; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
668 } |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
669 uint8_t UART_isCO2Connected() |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
670 { |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
671 return CO2Connected; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
672 } |
| 742 | 673 uint8_t UART_isSentinelConnected() |
| 674 { | |
| 675 return SentinelConnected; | |
| 676 } | |
|
729
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
677 |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
678 void UART_setTargetChannel(uint8_t channel) |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
679 { |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
680 ppO2TargetChannel = channel; |
|
d646a0f724a7
Added auto detection functionality for sensors connected to the external interface:
Ideenmodellierer
parents:
725
diff
changeset
|
681 } |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
682 |
| 662 | 683 void HAL_UART_RxCpltCallback(UART_HandleTypeDef *huart) |
| 38 | 684 { |
| 662 | 685 if(huart == &huart1) |
| 686 { | |
| 687 dmaActive = 0; | |
| 688 rxWriteIndex+=CHUNK_SIZE; | |
| 689 if(rxWriteIndex >= CHUNK_SIZE * CHUNKS_PER_BUFFER) | |
| 690 { | |
| 691 rxWriteIndex = 0; | |
| 692 } | |
| 693 if((rxWriteIndex / CHUNK_SIZE) != (rxReadIndex / CHUNK_SIZE)) /* start next transfer if we did not catch up with read index */ | |
| 694 { | |
| 695 if(externalInterface_isEnabledPower33()) | |
| 696 { | |
|
704
f1b40364b0af
Added protocol functions for UART DiveO2 sensor:
Ideenmodellierer
parents:
690
diff
changeset
|
697 memset((char*)&rxBuffer[rxWriteIndex],(int)0,CHUNK_SIZE); |
| 742 | 698 UART_StartDMA_Receiption(); |
| 662 | 699 } |
| 700 } | |
| 701 } | |
| 38 | 702 } |
| 703 | |
| 704 | |
| 662 | 705 |
| 38 | 706 /************************ (C) COPYRIGHT heinrichs weikamp *****END OF FILE****/ |