Devbugfix UART buffer cleaning:
In the previous version a buffer cleaning function was used which resets the ringbuffer read index. As result the processing of data was stopped until the DMA write comes to the index 0. When reaching it the complete buffer was proceeded including possibly invalid data.
The usage of the cleanbuffer function was replaced by the flush buffer function (meaning the data is discarded but the data index is maintained). There was already a function for this. Because the function was 99% the same as the read function, it was integrated into the ReadData function. Calling the function with parameter flush = 1 will result in a buffer flush.
The workaround of the previous revision was updated to only be applied in case a DiveO2 sensor is operated in stand alone mode.
line source
///////////////////////////////////////////////////////////////////////////////+ −
/// -*- coding: UTF-8 -*-+ −
///+ −
/// \file Discovery/Src/tInfoCompass.c+ −
/// \brief there is only compass_DX_f, compass_DY_f, compass_DZ_f output during this mode+ −
/// \author heinrichs weikamp gmbh+ −
/// \date 23-Feb-2015+ −
///+ −
/// \details+ −
///+ −
/// $Id$+ −
///////////////////////////////////////////////////////////////////////////////+ −
/// \par Copyright (c) 2014-2018 Heinrichs Weikamp gmbh+ −
///+ −
/// This program is free software: you can redistribute it and/or modify+ −
/// it under the terms of the GNU General Public License as published by+ −
/// the Free Software Foundation, either version 3 of the License, or+ −
/// (at your option) any later version.+ −
///+ −
/// This program is distributed in the hope that it will be useful,+ −
/// but WITHOUT ANY WARRANTY; without even the implied warranty of+ −
/// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the+ −
/// GNU General Public License for more details.+ −
///+ −
/// You should have received a copy of the GNU General Public License+ −
/// along with this program. If not, see <http://www.gnu.org/licenses/>.+ −
//////////////////////////////////////////////////////////////////////////////+ −
+ −
/* Includes ------------------------------------------------------------------*/+ −
+ −
#include "gfx_engine.h"+ −
#include "gfx_fonts.h"+ −
#include "tHome.h"+ −
#include "tInfo.h"+ −
#include "tInfoSensor.h"+ −
#include "tMenuEdit.h"+ −
#include "data_exchange_main.h"+ −
+ −
#include <string.h>+ −
#include <inttypes.h>+ −
+ −
extern void openEdit_O2Sensors(void);+ −
uint8_t OnAction_Sensor (uint32_t editId, uint8_t blockNumber, uint8_t digitNumber, uint8_t digitContent, uint8_t action);+ −
+ −
/* Private variables ---------------------------------------------------------*/+ −
static uint8_t activeSensorId = 0;+ −
static uint8_t sensorActive = 0;+ −
/* Exported functions --------------------------------------------------------*/+ −
void openInfo_Sensor(uint8_t sensorId)+ −
{+ −
SSettings *pSettings = settingsGetPointer();+ −
activeSensorId = sensorId;+ −
set_globalState(StISENINFO);+ −
switch (activeSensorId)+ −
{+ −
case 2: setBackMenu((uint32_t)openEdit_O2Sensors,0,3);+ −
break;+ −
case 1: setBackMenu((uint32_t)openEdit_O2Sensors,0,2);+ −
break;+ −
default:+ −
case 0: setBackMenu((uint32_t)openEdit_O2Sensors,0,1);+ −
break;+ −
}+ −
sensorActive = 1;+ −
if(pSettings->ppo2sensors_deactivated & (1 << (activeSensorId)))+ −
{+ −
sensorActive = 0;+ −
}+ −
DataEX_setExtInterface_Cmd(EXT_INTERFACE_O2_INDICATE, activeSensorId);+ −
}+ −
+ −
+ −
uint8_t OnAction_Sensor(uint32_t editId, uint8_t blockNumber, uint8_t digitNumber, uint8_t digitContent, uint8_t action)+ −
{+ −
if(settingsGetPointer()->ppo2sensors_deactivated & (1 << (activeSensorId)))+ −
{+ −
settingsGetPointer()->ppo2sensors_deactivated &= ~(1 << (activeSensorId));+ −
tMenuEdit_set_on_off(editId, 1);+ −
}+ −
else+ −
{+ −
settingsGetPointer()->ppo2sensors_deactivated |= (1 << (activeSensorId));+ −
tMenuEdit_set_on_off(editId, 0);+ −
}+ −
return UPDATE_DIVESETTINGS;+ −
}+ −
+ −
+ −
+ −
uint64_t mod64(uint64_t a, uint64_t b)+ −
{+ −
uint64_t div;+ −
div=(a/10);+ −
b=(10*div);+ −
return (a-b);+ −
}+ −
+ −
void uint64ToString(uint64_t value, char* pbuf)+ −
{+ −
char tmpBuf[32];+ −
uint8_t index = 31;+ −
+ −
tmpBuf[index--] = 0; /* zero termination */+ −
while((index != 0) && (value != 0))+ −
{+ −
tmpBuf[index--] = '0' + (value % 10);// mod64(worker64,10);+ −
value /= 10;+ −
}+ −
strcpy(pbuf,&tmpBuf[index+1]);+ −
}+ −
+ −
+ −
static void refreshInfo_SensorO2(GFX_DrawCfgScreen s)+ −
{+ −
const SDiveState *pStateReal = stateRealGetPointer();+ −
SSensorDataDiveO2* pDiveO2Data;+ −
char text[31];+ −
uint8_t strIndex = 0;+ −
char *textPointer = text;+ −
+ −
float pressure = 0.0;+ −
+ −
pDiveO2Data = (SSensorDataDiveO2*)pStateReal->lifeData.extIf_sensor_data[activeSensorId];+ −
strIndex = snprintf(text,32,"ID: ");+ −
if(pDiveO2Data->sensorId != 0)+ −
{+ −
uint64ToString(pDiveO2Data->sensorId,&text[strIndex]);+ −
}+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE1, &FontT48, text, CLUT_Font020);+ −
snprintf(text,32,"%c: %02.1f",TXT_Temperature , (float)pDiveO2Data->temperature / 1000.0);+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE2, &FontT48, text, CLUT_Font020);+ −
+ −
#ifdef ENABLE_EXTERNAL_PRESSURE+ −
pressure = (float)(stateRealGetPointer()->lifeData.ppO2Sensor_bar[2]);+ −
#else+ −
pressure = (float)pDiveO2Data->pressure / 1000.0;+ −
#endif+ −
snprintf(text,32,"Druck: %02.1f (%02.1f)", (float)pDiveO2Data->pressure / 1000.0, pressure *1000.0);+ −
+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE3, &FontT48, text, CLUT_Font020);+ −
snprintf(text,32,"Feuchtigkeit: %02.1f", (float)pDiveO2Data->humidity / 1000.0);+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE4, &FontT48, text, CLUT_Font020);+ −
snprintf(text,32,"Status: 0x%lx", pDiveO2Data->status);+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE5, &FontT48, text, CLUT_Font020);+ −
#ifdef ENABLE_EXTERNAL_PRESSURE+ −
snprintf(text,32,"Norm ppO2: %02.3f (%02.1f)", (float)(stateRealGetPointer()->lifeData.ppO2Sensor_bar[0] / (pressure / 1000.0)),(float)(stateRealGetPointer()->lifeData.ppO2Sensor_bar[0]));+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE6, &FontT48, text, CLUT_Font020);+ −
#endif+ −
+ −
if(sensorActive)+ −
{+ −
*textPointer++ = '\005';+ −
}+ −
else+ −
{+ −
*textPointer++ = '\006';+ −
}+ −
*textPointer++ = ' ';+ −
*textPointer++ = TXT_2BYTE;+ −
*textPointer++ = TXT2BYTE_Sensor;+ −
*textPointer++ = ' ';+ −
*textPointer++ = TXT_2BYTE;+ −
*textPointer++ = TXT2BYTE_O2IFDigital;+ −
*textPointer++ = '1' + activeSensorId;+ −
+ −
snprintf(textPointer, 20,": %01.2f, %01.1f mV", pStateReal->lifeData.ppO2Sensor_bar[activeSensorId], pStateReal->lifeData.sensorVoltage_mV[activeSensorId]);+ −
+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE6, &FontT48, text, CLUT_Font020);+ −
+ −
tInfo_write_buttonTextline_simple(TXT2BYTE_ButtonBack,TXT2BYTE_ButtonEnter,0);+ −
}+ −
+ −
static void refreshInfo_SensorCo2(GFX_DrawCfgScreen s)+ −
{+ −
const SDiveState *pStateReal = stateRealGetPointer();+ −
char text[31];+ −
char *textPointer = text;+ −
+ −
snprintf(text,32,"CO2: %ld ppm",pStateReal->lifeData.CO2_data.CO2_ppm);+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE1, &FontT48, text, CLUT_Font020);+ −
+ −
+ −
snprintf(text,32,"Signal: %d",pStateReal->lifeData.CO2_data.signalStrength);+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE2, &FontT48, text, CLUT_Font020);+ −
+ −
if(sensorActive)+ −
{+ −
*textPointer++ = '\005';+ −
}+ −
else+ −
{+ −
*textPointer++ = '\006';+ −
}+ −
*textPointer++ = ' ';+ −
*textPointer++ = TXT_2BYTE;+ −
*textPointer++ = TXT2BYTE_Sensor;+ −
*textPointer++ = ' ';+ −
*textPointer++ = 'C';+ −
*textPointer++ = 'o';+ −
*textPointer++ = '1' + activeSensorId;+ −
+ −
snprintf(textPointer, 20,": %ld ppm", pStateReal->lifeData.CO2_data.CO2_ppm);+ −
+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE6, &FontT48, text, CLUT_Font020);+ −
+ −
tInfo_write_buttonTextline_simple(TXT2BYTE_ButtonBack,TXT2BYTE_ButtonEnter,TXT2BYTE_O2Calib);+ −
}+ −
// ===============================================================================+ −
void refreshInfo_Sensor(GFX_DrawCfgScreen s)+ −
{+ −
const SDiveState *pStateReal = stateRealGetPointer();+ −
+ −
char text[31];+ −
+ −
text[0] = '\001';+ −
text[1] = TXT_Sensor;+ −
text[2] = ' ';+ −
text[3] = TXT_Information;+ −
text[4] = ' ';+ −
text[5] = '1' + activeSensorId;+ −
text[6] = 0;+ −
tInfo_write_content_simple( 30, 770, ME_Y_LINE_BASE, &FontT48, text, CLUT_MenuPageHardware);+ −
+ −
switch(pStateReal->lifeData.extIf_sensor_map[activeSensorId])+ −
{+ −
default:+ −
case SENSOR_DIGO2M: refreshInfo_SensorO2(s);+ −
break;+ −
case SENSOR_CO2M: refreshInfo_SensorCo2(s);+ −
break;+ −
}+ −
}+ −
+ −
void sendActionToInfoSensor(uint8_t sendAction)+ −
{+ −
switch(sendAction)+ −
{+ −
case ACTION_BUTTON_BACK:+ −
exitMenuEdit_to_BackMenu();+ −
break;+ −
+ −
case ACTION_BUTTON_ENTER: if(settingsGetPointer()->ppo2sensors_deactivated & (1 << (activeSensorId)))+ −
{+ −
if(stateRealGetPointer()->lifeData.extIf_sensor_map[activeSensorId] == SENSOR_CO2M)+ −
{+ −
settingsGetPointer()->co2_sensor_active = 1;+ −
}+ −
settingsGetPointer()->ppo2sensors_deactivated &= ~(uint8_t)(1 << (activeSensorId));+ −
sensorActive = 1;+ −
}+ −
else+ −
{+ −
if(stateRealGetPointer()->lifeData.extIf_sensor_map[activeSensorId] == SENSOR_CO2M)+ −
{+ −
settingsGetPointer()->co2_sensor_active = 0;+ −
}+ −
settingsGetPointer()->ppo2sensors_deactivated |= (uint8_t)(1 << (activeSensorId));+ −
sensorActive = 0;+ −
}+ −
break;+ −
case ACTION_BUTTON_NEXT: if(stateRealGetPointer()->lifeData.extIf_sensor_map[activeSensorId] == SENSOR_CO2M)+ −
{+ −
DataEX_setExtInterface_Cmd(EXT_INTERFACE_CO2_CALIB, activeSensorId);+ −
}+ −
break;+ −
case ACTION_TIMEOUT:+ −
case ACTION_MODE_CHANGE:+ −
case ACTION_IDLE_TICK:+ −
case ACTION_IDLE_SECOND:+ −
default:+ −
break;+ −
}+ −
}+ −
+ −