view Discovery/Src/t4_tetris.c @ 173:05c770dc2911 max-depth

Bugfix: make max depth move with current depth (part 1) The display in dive mode of the max depth was updated before the actual depth, which looks very strange. The reason for this was conceptually simple. The depth value was averaged over a set of depth samples, but the current depth was only taken from the current sample. So, per definition, on an initial descend, the current depth is always bigger (deeper) than any average from previous shallower samples. This part 1 commit introduces a new function that is used immediate after reception of the new sample from the RTE. This function does the trivial average of a set of samples. Notice that also the surface and ambient mbar pressures are taken into account (which are used heavily over the entire code). This is a consistency thing. We should base any further calculation from the data presented in the UI, instead of presenting A, and use A' for further calculations. Signed-off-by: Jan Mulder <jlmulder@xs4all.nl>
author Jan Mulder <jlmulder@xs4all.nl>
date Mon, 11 Mar 2019 19:48:57 +0100
parents 255eedad4155
children ecb71521d004
line wrap: on
line source

///////////////////////////////////////////////////////////////////////////////
/// -*- coding: UTF-8 -*-
///
/// \file   Discovery/Src/t4_tetris.c
/// \brief  Main Template file for dive mode special screen t4_tetris
/// \author Heinrichs Weikamp gmbh
/// \date   17-Feb-2016
///
/// \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 "t4_tetris.h"

#include "data_exchange_main.h"
#include "decom.h"
#include "gfx_fonts.h"
#include "math.h"
#include "tHome.h"
#include "timer.h"
#include "unit.h"

/* Exported variables --------------------------------------------------------*/

/* Private variables ---------------------------------------------------------*/
GFX_DrawCfgScreen	t4screen;
GFX_DrawCfgWindow	t4l1;
GFX_DrawCfgWindow	t4l2;
GFX_DrawCfgWindow	t4l3;

extern float depthLastCall[9];
extern uint8_t idDepthLastCall;
extern float temperatureLastCall[3];
extern uint8_t idTemperatureLastCall;


/* Private types -------------------------------------------------------------*/
#define TEXTSIZE 16

const uint16_t t4SeperationLeftRight = 250;
const uint16_t t4SeperationTopMid = 315;
const uint16_t t4SeperationMidBottom = 139;

/* Private function prototypes -----------------------------------------------*/
void t4_refresh_divemode(void);
void t4_refresh_customview(float depth);

uint8_t t4_test_customview_warnings(void);
void t4_show_customview_warnings(void);
void t4_battery_low_customview_extra(void);

/* Exported functions --------------------------------------------------------*/

void t4_init(void)
{
    t4screen.FBStartAdress = 0;
    t4screen.ImageHeight = 480;
    t4screen.ImageWidth = 800;
    t4screen.LayerIndex = 1;

    t4l1.Image = &t4screen;
    t4l1.WindowNumberOfTextLines = 2;
    t4l1.WindowLineSpacing = 19; // Abstand von Y0
    t4l1.WindowTab = 100;
    t4l1.WindowX0 = 0;
    t4l1.WindowX1 = t4SeperationLeftRight - 2;
    t4l1.WindowY1 = 479;
    t4l1.WindowY0 = t4SeperationTopMid + 3;

    t4l2.Image = t4l1.Image;
    t4l2.WindowNumberOfTextLines = t4l1.WindowNumberOfTextLines;
    t4l2.WindowLineSpacing = t4l1.WindowLineSpacing;
    t4l2.WindowTab = t4l1.WindowTab;
    t4l2.WindowX0 = t4l1.WindowX0;
    t4l2.WindowX1 = t4l1.WindowX1;
    t4l2.WindowY1 = t4SeperationTopMid - 2;
    t4l2.WindowY0 = t4SeperationMidBottom + 3;

    t4l3.Image = t4l1.Image;
    t4l3.WindowNumberOfTextLines = t4l1.WindowNumberOfTextLines;
    t4l3.WindowLineSpacing = t4l1.WindowLineSpacing;
    t4l3.WindowTab = t4l1.WindowTab;
    t4l3.WindowX0 = t4l1.WindowX0;
    t4l3.WindowX1 = t4l1.WindowX1;
    t4l3.WindowY1 = t4SeperationMidBottom - 2;
    t4l3.WindowY0 = 0;
}


void t4_refresh(void)
{
    SStateList status;
    get_globalStateList(&status);

    if(stateUsed->mode != MODE_DIVE)
    {
        settingsGetPointer()->design = 7;
        return;
    }

    if(status.base != BaseHome)
        return;

    t4screen.FBStartAdress = getFrame(25);
    t4_refresh_divemode();
    GFX_SetFramesTopBottom(t4screen.FBStartAdress, 0,480);
    releaseAllFramesExcept(25,t4screen.FBStartAdress);
}


/* Private functions ---------------------------------------------------------*/

void t4_refresh_divemode(void)
{
    char text[512];
//	uint8_t textpointer = 0;
//	uint8_t  customview_warnings = 0;

    point_t start, stop;

    start.x = 0;
    stop.x = t4SeperationLeftRight;
    stop.y = start.y = t4SeperationTopMid;
    GFX_draw_line(&t4screen, start, stop, CLUT_Font020);

    stop.y = start.y = t4SeperationMidBottom;
    GFX_draw_line(&t4screen, start, stop, CLUT_Font020);

    start.y = 0;
    stop.y = 479;
    stop.x = start.x = t4SeperationLeftRight;
    GFX_draw_line(&t4screen, start, stop, CLUT_Font020);


    // depth
    float depth = 0;
    float depthThisCall = unit_depth_float(stateUsed->lifeData.depth_meter);
    if(is_stateUsedSetToSim())
    {
        depth = (depthThisCall + depthLastCall[0] + depthLastCall[1] + depthLastCall[2] + depthLastCall[3] + depthLastCall[4] + depthLastCall[5] + depthLastCall[6] + depthLastCall[7] + depthLastCall[8]) / 10.0f;

        idDepthLastCall++;
        if(idDepthLastCall >= 9)
            idDepthLastCall = 0;
        depthLastCall[idDepthLastCall] = depthThisCall;
    }
    else
    {
        depth = (depthThisCall + depthLastCall[0] + depthLastCall[1] + depthLastCall[2]) / 4.0f;

        idDepthLastCall++;
        if(idDepthLastCall >= 3)
            idDepthLastCall = 0;
        depthLastCall[idDepthLastCall] = depthThisCall;
    }

    if(depth <= 0.3f)
        depth = 0;

    snprintf(text,TEXTSIZE,"\032\f%c",TXT_Depth);
    GFX_write_string(&FontT24,&t4l1,text,0);

    if( depth < 100)
        snprintf(text,TEXTSIZE,"\020%01.1f",depth);
    else
        snprintf(text,TEXTSIZE,"\020%01.0f",depth);

    t3_basics_colorscheme_mod(text);
    GFX_write_string(&FontT144,&t4l1,text,1);

    // divetime
    SDivetime Divetime = {0,0,0, 0};

    Divetime.Total = stateUsed->lifeData.dive_time_seconds_without_surface_time;
    Divetime.Minutes = Divetime.Total / 60;
    Divetime.Seconds = Divetime.Total - ( Divetime.Minutes * 60 );

    SDivetime TimeoutTime = {0,0,0,0};
    TimeoutTime.Total = settingsGetPointer()->timeoutDiveReachedZeroDepth - stateUsed->lifeData.counterSecondsShallowDepth;
    if(TimeoutTime.Total > settingsGetPointer()->timeoutDiveReachedZeroDepth)
    {
        TimeoutTime.Total = 0;
    }
    TimeoutTime.Minutes = TimeoutTime.Total / 60;
    TimeoutTime.Seconds = TimeoutTime.Total - (TimeoutTime.Minutes * 60);

    if(stateUsed->lifeData.counterSecondsShallowDepth)
    {
        snprintf(text,TEXTSIZE,"\f\136 %u:%02u",TimeoutTime.Minutes, TimeoutTime.Seconds);
        GFX_write_string(&FontT42,&t4l2,text,0);
    }
    else
    {
        snprintf(text,TEXTSIZE,"\032\f%c",TXT_Divetime);
        GFX_write_string(&FontT42,&t4l2,text,0);
    }

    if(Divetime.Minutes < 1000)
        snprintf(text,TEXTSIZE,"\020\016%u:%02u",Divetime.Minutes, Divetime.Seconds);
    else
        snprintf(text,TEXTSIZE,"\020\016%u'",Divetime.Minutes);
    t3_basics_colorscheme_mod(text);
    GFX_write_string(&FontT105,&t4l2,text,1);
}