UL/TX
2
0
Fork 0
Code Issues Pull Requests Actions Packages Projects 1 Releases Wiki Activity
Files
372e4941a201c8967a1a13a0ef040959b6561e77
TX/source/display.c

873 lines
18 KiB
C
Raw Blame History

/*
* display.c
*
* Created on: Jun 17, 2022
* Author: Keith.Lloyd
*/
#include <stdio.h>
#include <math.h>
#include <stdbool.h>
#include <string.h>
#include <stdint.h>
#include <arm_math.h>
#include "fsl_gpio.h"
#include "spi.h"
#include "lcd.h"
#include "display.h"
//#include "frq.h"
#include "battery.h"
#include "utils.h"
#include "Graphics/splash.h"
#include "Graphics/graphicsLibrary.h"
#include "Fonts/fontLibrary.h"
#include "Graphics/testIconsMono.h"
#include "Graphics/icons.h"
#include "adc.h"
#include "mode.h"
#include "ports.h"
#include "timer.h"
#include "taps.h"
#include "main.h"
#include "hwFixes.h"
#include "menu.h"
#include "System\system.h"
uint8_t tempString[40]; // Todo move
uint8_t frequency = 0;
uint32_t new_freq;
float32_t Volts = 96.345;
uint16_t Bcast_Pwr_Dispval[5] = {0,25,50,75,100}; // broadcast value to display.
uint32_t Safety_Select = false;
float32_t Milli_amps;
float32_t Watts_Filt;
extern SYSTEM_DATA_t sys;
extern uint8_t Bat_Type, Cur_Mode, Task, Over_Voltage_Flag, Error;
extern MODE_REC_t mode_Array[];
extern uint8_t Bcast_Pwr_Level;
extern uint8_t Power_Level,Test_Mode,LD_Flag;
extern float32_t volts_check;
extern uint8_t Port_State[];
extern uint8_t Dds_Pot_Val[];
extern HARDWARE_FIX_t hwf;
extern float32_t test_val2;
extern uint32_t systemTime;
extern ClampData_t clampData;
void Display_Bcast(void)
{
if(Cur_Mode == BROADCAST)
{
sprintf(tempString,"%d%%",Bcast_Pwr_Dispval[Bcast_Pwr_Level]);
FL_DrawString( tempString, LCD_X_MID, 60, font18Bold, LCD_DRAW_SET, FL_ALIGN_CENTER);
Display_Level(Bcast_Pwr_Level);
}
}
void Display_USB(void)
{
GL_DrawMonoBitmap(usbIconSmall, LCD_X_MIN + 30, LCD_Y_MAX - usbIconSmall[1], LCD_DRAW_SET);
}
void Display_Splash(void)
{
LCD_Clear();
// if(Read_Model_type() != LEICA)
// GL_DrawMonoBitmapCentered(UMLogo68x64, LCD_DRAW_SET);
// else
// GL_DrawMonoBitmapCentered(leicaSplash, LCD_DRAW_SET);
// LCD_Update();
switch(Read_Model_type())
{
case UMAG:
GL_DrawMonoBitmapCentered(UMLogo68x64, LCD_DRAW_SET);
break;
case LEICA:
GL_DrawMonoBitmapCentered(leicaSplash, LCD_DRAW_SET);
break;
case GLAND:
GL_DrawMonoBitmapCentered(goldenlandLogo98x60, LCD_DRAW_SET);
break;
default:
GL_DrawMonoBitmapCentered(UMLogo68x64, LCD_DRAW_SET);
break;
}
LCD_Update();
}
uint8_t Read_Model_type()
{
if(strncmp(sys.modelName,"10W",3) == 0 )
return(UMAG);
if(strncmp(sys.modelName,"DE100",5) == 0 )
return(LEICA);
if(strncmp(sys.modelName,"GT3",3) == 0 )
return(GLAND);
if(strncmp(sys.modelName,"Nexus",5) == 0 )
return(UMAG);
if(strncmp(sys.modelName,"Tx10",4) == 0 )
return(UMAG);
}
void Display_Volts(void)
{
if((( Cur_Mode != BROADCAST) && (!Is_Clamp_Detected())))
Display_Line_Voltage();
#if 0// testing the new averager
sprintf(tempString,"%.2fmA",sys.adc.I_OUT_SlowFilt* 1000.0);
FL_DrawString( tempString, X_POS_MA+50, 18, font16Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
#endif
}
void Display_Line_Voltage(void)
{
Volts = sys.adc.V_OUT_FastFilt;
if(Volts < 0)
Volts = 0;
sprintf(tempString,"%.0fVa",Volts);
FL_DrawString( tempString, X_POS_MA+90, 48, font16Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
GL_DrawLine( X_POS_MA+90, 74, X_POS_MA+130, 74, 3, LCD_DRAW_SET);
}
void Display_Clamp_Power(void)
{
float power = 0.0f;
Volts = sys.adc.V_OUT_FastFilt;
if(Volts < 0)
Volts = 0;
power = Volts * sys.adc.I_OUT_FastFilt;
sprintf(tempString,"%.1fW", power);
FL_DrawString( tempString, LCD_X_MID -10, 60, font18Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
}
void Display_Clamp_Volts(void)
{
Volts = sys.adc.V_OUT_FastFilt;
if(Volts < 0)
Volts = 0;
sprintf(tempString,"%.0fVb",Volts);
FL_DrawString( tempString, LCD_X_MID -10, 60, font18Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
}
void Display_Current(void)
{
if(( Cur_Mode != BROADCAST) && (!Is_Clamp_Detected()))
Display_Line_Current();
}
void Display_Ohms(void)
{
if(( Cur_Mode != BROADCAST) && (!Is_Clamp_Detected()))
Display_Line_Ohms();
}
void Display_Line_Current(void)
{
Milli_amps = sys.adc.I_OUT_SlowFilt;
if(Milli_amps < 0)
Milli_amps = 0;
sprintf(tempString,"%.0fmA =",Milli_amps * 1000.0);
FL_DrawString( tempString, X_POS_MA+85, 60, font16Bold, LCD_DRAW_SET, FL_ALIGN_RIGHT);
}
void Display_Line_Ohms(void)
{
if(sys.adc.Ohms_slowfilt < 0)
sys.adc.Ohms_slowfilt = 0;
if(sys.adc.Ohms_slowfilt < 10000)
{
sprintf(tempString,"%.0fΩ",sys.adc.Ohms_slowfilt);
FL_DrawString( tempString, X_POS_MA+90, 72, font16Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
}
else
{
if(sys.adc.Ohms_slowfilt < 100000)
{
sprintf(tempString,"%.0f kΩ",sys.adc.Ohms_slowfilt/1000);
FL_DrawString( tempString, X_POS_MA+90, 72, font16Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
}
else
FL_DrawString( "- - - Ω", X_POS_MA+90, 72, font16Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
}
}
void Display_Watts(void)
{
if(( Cur_Mode != BROADCAST) && (!Is_Clamp_Detected()))
{
if(Watts_Filt < 0)
Watts_Filt = 0;
sprintf(tempString,"%.1fW",Watts_Filt );
FL_DrawString( tempString, LCD_X_MAX+4, LCD_Y_MAX-40, font16Bold, LCD_DRAW_SET, FL_ALIGN_RIGHT);
}
}
void Display_Line_Watts(void)
{
if(Watts_Filt < 0)
Watts_Filt = 0;
sprintf(tempString,"%.1fW",Watts_Filt );
FL_DrawString( tempString, LCD_X_MAX+4, LCD_Y_MAX-40, font16Bold, LCD_DRAW_SET, FL_ALIGN_RIGHT);
}
void Display_BroadCastSignal(void)
{
}
void Display_Battery(void)
{
if(Bat_Type != EXT_DC)
{
if(hwf.vBattCap_021)
Display_Battery_CF();
else
Display_Battery_NC();
}
else
Display_EXT_DC();
}
void Display_EXT_DC(void)
{
sprintf(tempString, "EXT_DC");
FL_DrawString(tempString, 0, LCD_Y_MAX - 22, font18Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
}
void Display_Battery_NC() // No Cap
{
// battery = Adjust_Battery_For_Load(); //adjust battery dependant on load and Vdrop
if (Bat_Type == LITHIUM)
{
if(sys.adc.V_BAT >= NCL_BATTERY_NINETY)
Draw_Battery(STACKS_4);
else if(sys.adc.V_BAT > NCL_BATTERY_3QUARTERS)
Draw_Battery(STACKS_3);
else if(sys.adc.V_BAT > NCL_BATTERY_FIFTY)
Draw_Battery(STACKS_2);
else if(sys.adc.V_BAT > NCL_BATTERY_1QUARTER)
Draw_Battery(STACKS_1);
else if (sys.adc.V_BAT > NCL_BATTERY_1EIGTH)
Draw_Battery(STACKS_EMPTY);
else
Display_Bat_Frame_Flash();
}
else
{
if(sys.adc.V_BAT >= NCA_BATTERY_NINETY)
Draw_Battery(STACKS_4);
else if(sys.adc.V_BAT > NCA_BATTERY_3QUARTERS)
Draw_Battery(STACKS_3);
else if(sys.adc.V_BAT > NCA_BATTERY_FIFTY)
Draw_Battery(STACKS_2);
else if(sys.adc.V_BAT > NCA_BATTERY_1QUARTER)
Draw_Battery(STACKS_1);
else if (sys.adc.V_BAT > NCA_BATTERY_1EIGTH)
Draw_Battery(STACKS_EMPTY);
else
Display_Bat_Frame_Flash();
}
}
void Display_Battery_CF() // cap fitted
{
// battery = Adjust_Battery_For_Load(); //adjust battery dependant on load and Vdrop
if (Bat_Type == LITHIUM)
{
if(sys.adc.V_BAT >= L_BATTERY_NINETY)
Draw_Battery(STACKS_4);
else if(sys.adc.V_BAT > L_BATTERY_3QUARTERS)
Draw_Battery(STACKS_3);
else if(sys.adc.V_BAT > L_BATTERY_FIFTY)
Draw_Battery(STACKS_2);
else if(sys.adc.V_BAT > L_BATTERY_1QUARTER)
Draw_Battery(STACKS_1);
else if (sys.adc.V_BAT > L_BATTERY_1EIGTH)
Draw_Battery(STACKS_EMPTY);
else
Display_Bat_Frame_Flash();
}
else
{
if(sys.adc.V_BAT >= A_BATTERY_NINETY)
Draw_Battery(STACKS_4);
else if(sys.adc.V_BAT > A_BATTERY_3QUARTERS)
Draw_Battery(STACKS_3);
else if(sys.adc.V_BAT > A_BATTERY_FIFTY)
Draw_Battery(STACKS_2);
else if(sys.adc.V_BAT > A_BATTERY_1QUARTER)
Draw_Battery(STACKS_1);
else if (sys.adc.V_BAT > A_BATTERY_1EIGTH)
Draw_Battery(STACKS_EMPTY);
else
Display_Bat_Frame_Flash();
}
}
void Draw_Battery(uint8_t stacks)
{
uint16_t battx = 0;
uint16_t batty = LCD_Y_MAX - GL_GetMonoBitmapHeight(battery0)+3;
switch(stacks)
{
case STACKS_4:
GL_DrawMonoBitmap(battery4, battx, batty, LCD_DRAW_SET); // Draw all 4
GL_DrawMonoBitmap(battery3, battx, batty, LCD_DRAW_SET);
GL_DrawMonoBitmap(battery2, battx, batty, LCD_DRAW_SET);
GL_DrawMonoBitmap(battery1, battx, batty, LCD_DRAW_SET);
GL_DrawMonoBitmap(battery0, battx, batty, LCD_DRAW_SET);
break;
case STACKS_3:
GL_DrawMonoBitmap(battery3, battx, batty, LCD_DRAW_SET);
GL_DrawMonoBitmap(battery2, battx, batty, LCD_DRAW_SET);
GL_DrawMonoBitmap(battery1, battx, batty, LCD_DRAW_SET);
GL_DrawMonoBitmap(battery0, battx, batty, LCD_DRAW_SET);
break;
case STACKS_2:
GL_DrawMonoBitmap(battery2, battx, batty, LCD_DRAW_SET);
GL_DrawMonoBitmap(battery1, battx, batty, LCD_DRAW_SET);
GL_DrawMonoBitmap(battery0, battx, batty, LCD_DRAW_SET);
break;
case STACKS_1:
GL_DrawMonoBitmap(battery1, battx, batty, LCD_DRAW_SET);
GL_DrawMonoBitmap(battery0, battx, batty, LCD_DRAW_SET);
break;
case STACKS_0:
GL_DrawMonoBitmap(battery0, battx, batty, LCD_DRAW_SET);
break;
}
}
void Display_Bat_Frame_Flash(void)
{
static uint8_t flasher = 0;
uint16_t battx = 0;
uint16_t batty = LCD_Y_MAX - GL_GetMonoBitmapHeight(battery0)+3;
if(flasher > 3)
{
GL_DrawMonoBitmap(battery0, battx, batty, LCD_DRAW_SET);
flasher = 0;
}
else
flasher++;
}
void Display_Wireless(uint8_t wireless)
{
if(wireless)
GL_DrawMonoBitmap(txControl, LCD_X_MID-90, LCD_Y_MAX-22, LCD_DRAW_SET);
}
//void Display_Level(PWR_MODE_t Level)
void displayLevel(void)
{
PowerLevel_t level = driver_getPowerLevel();
GL_DrawRectangle( 70, LCD_Y_MIN+15, 90, LCD_Y_MIN + 1, 2, LCD_DRAW_SET);
GL_DrawRectangle( 94, LCD_Y_MIN+15, 114, LCD_Y_MIN + 1, 2, LCD_DRAW_SET);
GL_DrawRectangle(118, LCD_Y_MIN+15, 138, LCD_Y_MIN + 1, 2, LCD_DRAW_SET);
GL_DrawRectangle(142, LCD_Y_MIN+15, 162, LCD_Y_MIN + 1, 2, LCD_DRAW_SET);
switch(level)
{
case POWER_LEVEL_4:
GL_DrawFilledRectangle(142, LCD_Y_MIN+15, 162, LCD_Y_MIN + 1, LCD_DRAW_SET);
case POWER_LEVEL_3:
GL_DrawFilledRectangle(118, LCD_Y_MIN+15, 138, LCD_Y_MIN + 1, LCD_DRAW_SET);
case POWER_LEVEL_2:
GL_DrawFilledRectangle( 94, LCD_Y_MIN+15, 114, LCD_Y_MIN + 1, LCD_DRAW_SET);
case POWER_LEVEL_1:
GL_DrawFilledRectangle( 70, LCD_Y_MIN+15, 90, LCD_Y_MIN + 1, LCD_DRAW_SET);
}
}
void Display_Backlight(uint8_t Back_Light)
{
if (Back_Light)
GL_DrawMonoBitmap(lamp, LCD_X_MIN+0, LCD_Y_MIN+30, LCD_DRAW_SET);
}
void Display_High_Voltage(void)
{
GL_DrawMonoBitmap(highVoltageIcon, LCD_X_MIN+0, LCD_Y_MIN+0, LCD_DRAW_SET);
}
void Display_Frequency(uint8_t frequency)
{
#if 0
// if (freqArray[frequency].frequency2 > 0)
// Display_CD_Symbol(); // place a CD symbol in front in correct position
if(LD_Flag)
Display_CD_Symbol(); // place a CD symbol in front in correct position
if (freqArray[frequency].frequency1 < 1000)
sprintf(tempString,"%dHz", freqArray[frequency].frequency1);
if (freqArray[frequency].frequency1 < 10000 && freqArray[frequency].frequency1 >= 1000 )
sprintf(tempString,"%.2fkHz", (float32_t)freqArray[frequency].frequency1/1000.0 );
if (freqArray[frequency].frequency1 < 100000 && freqArray[frequency].frequency1 >= 10000)
sprintf(tempString,"%.1fkHz",(float32_t)freqArray[frequency].frequency1/1000 );
if (freqArray[frequency].frequency1 > 100000)
// {
// if(freqArray[frequency].frequency1 == 131148)
// sprintf(tempString,"%.0fKHz",(float32_t)132000/1000 );
// else
sprintf(tempString,"%.0fKHz",(float32_t)freqArray[frequency].frequency1/1000 );
// }
FL_DrawString( tempString, LCD_X_MAX+6, LCD_Y_MAX - 22, font18Bold, LCD_DRAW_SET, FL_ALIGN_RIGHT);
#endif
}
void Display_CD_Symbol(void)
{
// uint16_t ldy = LCD_Y_MAX - GL_GetMonoBitmapHeight(ld2)+3;
#if 0
if (freqArray[frequency].frequency1 < 1000)
GL_DrawMonoBitmap(ld, LCD_X_MAX - 90, LCD_Y_MAX - 16, LCD_DRAW_SET);
else
GL_DrawMonoBitmap(ld, LCD_X_MAX - 106, LCD_Y_MAX - 16, LCD_DRAW_SET);
#endif
}
void Display_Bye_Bye()
{
LCD_Clear();
Display_Splash();
// FL_DrawString("Bye Bye", 52, LCD_Y_MIN + 49 , font16Bold, LCD_DRAW_XOR, FL_ALIGN_LEFT);
LCD_Update();
}
void Display_Danger_Menu()
{
static uint32_t count = 0;
if (count < 3)
{
count++;
// FL_DrawString("Extreme Voltage! ", 16, LCD_Y_MIN + 19 , font16Bold, LCD_DRAW_XOR, FL_ALIGN_LEFT);
GL_DrawMonoBitmap(dangerousVoltage68x60, LCD_X_MIN+88, LCD_Y_MIN+30, LCD_DRAW_SET);
}
else
count = 0;
}
void Display_Estop(void)
{
static uint32_t count_msg_tmr = 0;
if(count_msg_tmr < 3)
{
FL_DrawString("Unsafe Voltage Detected !", 16, LCD_Y_MIN + 19 , font16Bold, LCD_DRAW_XOR, FL_ALIGN_LEFT);
count_msg_tmr++;
}
else
{
FL_DrawString(" ", 32, 16, font18Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
count_msg_tmr = 0;
}
}
void Display_Measurements(void)
{
Display_Volts();
Display_Current();
Display_Ohms();
Display_Watts();
}
void Display_Normal(void)
{
// Display_Measurements(); 3/11/24
if(Power_Level > 0)
Display_Currently_Selected();
Display_Battery();
Display_Mode(Cur_Mode);
Display_Wireless(0);
if(Cur_Mode == BROADCAST)
Display_Bcast();
else
Display_Level(Power_Level); // Display bars
//Display_Frequency(frequency);
if(Test_Mode)
FL_DrawString("BETA", LCD_X_MIN, LCD_Y_MIN-3, font16Bold, LCD_DRAW_XOR, FL_ALIGN_LEFT);
}
void Display_Flash_Bat(void)
{
static uint32_t flash_count = 0;
if(flash_count < 3)
{
LCD_Clear(); //clear the frameBuffer
FL_DrawString("Low Battery", X_POS_MA+85, LCD_Y_MIN + 48 , font16Bold, LCD_DRAW_XOR, FL_ALIGN_CENTER);
flash_count++;
}
else
{
// FL_DrawString(" ", 32, 16, font18Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
LCD_Clear(); //clear the frameBuffer
flash_count = 0;
}
}
void Display_Bat_Error(void)
{
static uint32_t count_msg_tmr = 0;
if(count_msg_tmr < 3)
{
FL_DrawString("Battery Insertion Error!", 16, LCD_Y_MIN + 19 , font16Bold, LCD_DRAW_XOR, FL_ALIGN_LEFT);
count_msg_tmr++;
}
else
{
FL_DrawString(" ", 16, LCD_Y_MIN +19, font18Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
count_msg_tmr = 0;
}
}
uint8_t Display_Taps(void)
{
uint8_t temp;
temp = Port_State[BOTTOM_SR] & 0b00011000; // preserve the taps
switch(temp)
{
case TAP1_LF_ON:
temp = 1;
break;
case TAP2_LF_ON:
temp = 2;
break;
case TAP3_LF_ON:
temp = 3;
break;
case TAP4_LF_ON:
temp = 4;
break;
default:
temp = 5;
}
return(temp);
}
void Display_Line_Measurements(void)
{
Display_Line_Voltage();
Display_Line_Current();
Display_Line_Ohms();
Display_Line_Watts();
}
void Display_USB_Status(void)
{
if(GPIO_PinRead(GPIO,1,6))
Display_USB();
// GL_DrawMonoBitmap(usbIconSmall, LCD_X_MID, 30, LCD_DRAW_SET);
}
void Display_Over_Voltage_Status(void)
{
static uint32_t county = 0;
if(sys.status[OVERVOLTAGE])
{
if(county<3)
{
county++;
Display_High_Voltage(); // TODO Display correct graphic once agreed
}
else
county = 0;
}
}
void Display_Fatal_Error(void)
{
sprintf(tempString,"Error %d", Error);
FL_DrawString(tempString, 80, 90, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
}
void Display_OnScreen_Diagnostics(void)
{
sprintf(tempString, "POT %d", Dds_Pot_Val[1]);
FL_DrawString(tempString, 0, 30, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
if((Port_State[MID_SR] & 0x40) > 0)
sprintf(tempString, "HI", Dds_Pot_Val[1]);
else
sprintf(tempString, "LO");
FL_DrawString(tempString, 0, 50, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
if(hwf.vBattCap_021)
sprintf(tempString, "CF");
else
sprintf(tempString, "CNF");
FL_DrawString(tempString, 0, 0, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
sprintf(tempString,"Taps %d", Display_Taps());
FL_DrawString(tempString, 0, 20, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
sprintf(tempString,"B %.2fV",sys.adc.V_BAT);
FL_DrawString(tempString, 0, 60, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
// sprintf(tempString,"VPSU %.2fV", sys.adc.V_PSU);
// FL_DrawString(tempString, 0, 80, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
sprintf(tempString,"C %.2fV",sys.adc.V_CHK);
FL_DrawString(tempString, 0, 70, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
// sprintf(tempString,"Time: %d", systemTime);
// FL_DrawString(tempString, 0, 80, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
//if (clampData.slope > 0)
{
float t = sqrtf(clampData.impedance * 10.0f);
//sprintf(tempString,"Vmax: %f", t);
sprintf(tempString,"Target: %f", clampData.targetPower);
FL_DrawString(tempString, 0, 80, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
}
// sprintf(tempString,"R %.2f",sys.adc.IRawFilt);
// FL_DrawString(tempString, 0, 80, font10Bold, LCD_DRAW_SET, FL_ALIGN_LEFT);
}
static void displayFrequency(void)
{
FREQUENCY_t *freq = driver_getFrequency();
if (freq->ldFrequency > 0)
{
Display_CD_Symbol(); // place a CD symbol in front in correct position
}
uint32_t value = freq->frequency;
if (value < 1000)
{
sprintf(tempString,"%dHz", value);
}
else
if (value < 10000 && value >= 1000 )
{
sprintf(tempString,"%.2fkHz", (float32_t)value/1000.0 );
}
else
if (value < 100000 && value >= 10000)
{
sprintf(tempString,"%.1fkHz",(float32_t)value/1000 );
}
else
if (value > 100000)
{
sprintf(tempString,"%.0fkHz",(float32_t)value/1000 );
}
FL_DrawString(tempString, LCD_X_MAX+6, LCD_Y_MAX - 22, font18Bold, LCD_DRAW_SET, FL_ALIGN_RIGHT);
}
static void displayMode(void)
{
SYSTEM_DATA_t * sys = system_getSys();
ACCESSORY_t *active = sys->activeAccessory;
if (active != NULL)
{
switch (active->connected)
{
case ID_BROADCAST:
{
GL_DrawMonoBitmap(inductionIcon, LCD_X_MAX-60,LCD_Y_MIN + 2, LCD_DRAW_SET);
break;
}
case ID_TX_SINGLE_DIRECT:
{
GL_DrawMonoBitmap(directConnectIcon5, LCD_X_MAX-60,LCD_Y_MIN + 2, LCD_DRAW_SET);
sprintf(sys->tmpString, "%d", active->portId);
FL_DrawString(sys->tmpString, LCD_X_MAX-40, LCD_Y_MIN, font12Bold, LCD_DRAW_SET, FL_ALIGN_RIGHT);
break;
}
case ID_TX_DUAL_DIRECT:
{
GL_DrawMonoBitmap(directConnectIcon3, LCD_X_MAX-60,LCD_Y_MIN + 2, LCD_DRAW_SET);
break;
}
case ID_CLAMP:
{
GL_DrawMonoBitmap(clampIcon2, LCD_X_MAX-60,LCD_Y_MIN + 2, LCD_DRAW_SET);
break;
}
case ID_CLAMP2:
{
GL_DrawMonoBitmap(clampIcon2, LCD_X_MAX-60,LCD_Y_MIN + 2, LCD_DRAW_SET);
FL_DrawString("V2", LCD_X_MAX-40, LCD_Y_MIN+30, font10Bold, LCD_DRAW_SET, FL_ALIGN_CENTER);
break;
}
}
}
return;
}
void Display_Update(void)
{
LCD_Clear(); //clear the frameBuffer
Display_USB_Status();
// display current mode information
displayMode();
displayLevel();
displayFrequency();
LCD_Update();
}
Reference in New Issue View Git Blame Copy Permalink