Compare commits
5 Commits
| Author | SHA1 | Date |
|---|---|---|
Jack Humbert
|
4582dfb103 | 7 years ago |
|
Jack Humbert
|
8e7537560d | 7 years ago |
|
Jack Humbert
|
a094696548 | 7 years ago |
|
Jack Humbert
|
636c5989de | 7 years ago |
|
Jack Humbert
|
d2856529ce | 7 years ago |
@ -0,0 +1,1141 @@
|
||||
/*
|
||||
This is an example of how to write a library that allows user to pass in an I2C port
|
||||
|
||||
Nathan Seidle
|
||||
SparkFun Electronics
|
||||
|
||||
License: Public domain
|
||||
*/
|
||||
|
||||
#include "hud.h"
|
||||
|
||||
//Initialize the I2C port
|
||||
bool begin(TwoWire & wirePort) {
|
||||
_i2cPort = & wirePort; //Grab which port the user wants us to use
|
||||
|
||||
_i2cPort - > begin();
|
||||
|
||||
initializeHUD231();
|
||||
}
|
||||
|
||||
void AdjustIconLevel(uint16_t IconNo, uint16_t IconLevel) {
|
||||
uint16_t Temp;
|
||||
uint16_t Temp_I;
|
||||
uint8_t StartBytePos;
|
||||
uint8_t StartRGBPos;
|
||||
uint8_t EndBytePos;
|
||||
uint8_t EndRGBPos;
|
||||
uint8_t BumpNoTemp;
|
||||
uint8_t Counter;
|
||||
// uint8_t Result;
|
||||
|
||||
if (IconLevel > 31) return; //If the IconLevel parameter is greater than 31, skip this function
|
||||
|
||||
BumpNoTemp = IconData[IconNo].BumpNo;
|
||||
Temp = IconData[IconNo].StartBumpLocation; //Bump Location counts from 0
|
||||
|
||||
StartBytePos = Temp / 3;
|
||||
StartRGBPos = Temp % 3; //A remainder of 0 means that the beginning Bump position is R, 1 means G, and 2 means B
|
||||
|
||||
//==================================================================================================================================================================
|
||||
// Processing the first data
|
||||
// Maybe it's only this one, maybe there's more
|
||||
//==================================================================================================================================================================
|
||||
switch (StartRGBPos) {
|
||||
case 0: //Location in R
|
||||
if (BumpNoTemp == 1) {
|
||||
IconRamMap[IconData[IconNo].DriverNo][StartBytePos] = ChangeRedValue(IconRamMap[IconData[IconNo].DriverNo][StartBytePos], IconLevel);
|
||||
} else if (BumpNoTemp == 2) {
|
||||
IconRamMap[IconData[IconNo].DriverNo][StartBytePos] = ChangeRG_Value(IconRamMap[IconData[IconNo].DriverNo][StartBytePos], IconLevel);
|
||||
} else if (BumpNoTemp >= 3) {
|
||||
IconRamMap[IconData[IconNo].DriverNo][StartBytePos] = SetRGB_Value(IconLevel);
|
||||
}
|
||||
SendDataBuffer[0] = 0x0A;
|
||||
SendDataBuffer[1] = StartBytePos >> 4; //X Start
|
||||
SendDataBuffer[2] = StartBytePos & 0x0F;
|
||||
SendDataBuffer[3] = 0x07; //X End
|
||||
SendDataBuffer[4] = 0x0F;
|
||||
SendDataBuffer[5] = 0; //Y Start
|
||||
SendDataBuffer[6] = 0;
|
||||
SendDataBuffer[7] = 0; //Y End
|
||||
SendDataBuffer[8] = 0;
|
||||
IIC_Write_Command1(IIC_Addr[IconData[IconNo].DriverNo], 9, SendDataBuffer);
|
||||
|
||||
SendDataBuffer[0] = (IconRamMap[IconData[IconNo].DriverNo][StartBytePos] & 0xFF00) >> 8;
|
||||
SendDataBuffer[1] = IconRamMap[IconData[IconNo].DriverNo][StartBytePos] & 0xFF;
|
||||
|
||||
if (BumpNoTemp <= 3) {
|
||||
IIC_Write_Data1(IIC_Addr[IconData[IconNo].DriverNo], 2, SendDataBuffer);
|
||||
return;
|
||||
} else {
|
||||
BumpNoTemp = BumpNoTemp - 3;
|
||||
}
|
||||
|
||||
break;
|
||||
case 1: //Location in G
|
||||
if (BumpNoTemp == 1) {
|
||||
IconRamMap[IconData[IconNo].DriverNo][StartBytePos] = ChangeGreenValue(IconRamMap[IconData[IconNo].DriverNo][StartBytePos], IconLevel);
|
||||
} else if (BumpNoTemp >= 2) {
|
||||
IconRamMap[IconData[IconNo].DriverNo][StartBytePos] = ChangeGB_Value(IconRamMap[IconData[IconNo].DriverNo][StartBytePos], IconLevel);
|
||||
}
|
||||
|
||||
//Set the position setting to write
|
||||
SendDataBuffer[0] = 0x0A;
|
||||
SendDataBuffer[1] = StartBytePos >> 4; //X Start
|
||||
SendDataBuffer[2] = StartBytePos & 0x0F;
|
||||
SendDataBuffer[3] = 0x07; //X End
|
||||
SendDataBuffer[4] = 0x0F;
|
||||
SendDataBuffer[5] = 0; //Y Start
|
||||
SendDataBuffer[6] = 0;
|
||||
SendDataBuffer[7] = 0; //Y End
|
||||
SendDataBuffer[8] = 0;
|
||||
IIC_Write_Command1(IIC_Addr[IconData[IconNo].DriverNo], 9, SendDataBuffer);
|
||||
|
||||
SendDataBuffer[0] = (IconRamMap[IconData[IconNo].DriverNo][StartBytePos] & 0xFF00) >> 8;
|
||||
SendDataBuffer[1] = IconRamMap[IconData[IconNo].DriverNo][StartBytePos] & 0xFF;
|
||||
IIC_Write_Data1(IIC_Addr[IconData[IconNo].DriverNo], 2, SendDataBuffer);
|
||||
|
||||
SendDataBuffer[0] = (IconRamMap[IconData[IconNo].DriverNo][StartBytePos] & 0xFF00) >> 8; //Store the first data in Buffer 0 & 1
|
||||
SendDataBuffer[1] = IconRamMap[IconData[IconNo].DriverNo][StartBytePos] & 0xFF;
|
||||
|
||||
if (BumpNoTemp <= 2) {
|
||||
IIC_Write_Data1(IIC_Addr[IconData[IconNo].DriverNo], 2, SendDataBuffer);
|
||||
return;
|
||||
} else {
|
||||
BumpNoTemp = BumpNoTemp - 2;
|
||||
}
|
||||
break;
|
||||
|
||||
case 2: //Location in B
|
||||
IconRamMap[IconData[IconNo].DriverNo][StartBytePos] = ChangeBlueValue(IconRamMap[IconData[IconNo].DriverNo][StartBytePos], IconLevel);
|
||||
//Set the position setting to write
|
||||
SendDataBuffer[0] = 0x0A;
|
||||
SendDataBuffer[1] = StartBytePos >> 4; //X Start
|
||||
SendDataBuffer[2] = StartBytePos & 0x0F;
|
||||
SendDataBuffer[3] = 0x07; //X End
|
||||
SendDataBuffer[4] = 0x0F;
|
||||
SendDataBuffer[5] = 0; //Y Start
|
||||
SendDataBuffer[6] = 0;
|
||||
SendDataBuffer[7] = 0; //Y End
|
||||
SendDataBuffer[8] = 0;
|
||||
IIC_Write_Command1(IIC_Addr[IconData[IconNo].DriverNo], 9, SendDataBuffer);
|
||||
|
||||
SendDataBuffer[0] = (IconRamMap[IconData[IconNo].DriverNo][StartBytePos] & 0xFF00) >> 8;
|
||||
SendDataBuffer[1] = IconRamMap[IconData[IconNo].DriverNo][StartBytePos] & 0xFF;
|
||||
|
||||
if (BumpNoTemp == 1) {
|
||||
IIC_Write_Data1(IIC_Addr[IconData[IconNo].DriverNo], 2, SendDataBuffer);
|
||||
return;
|
||||
} else {
|
||||
BumpNoTemp = BumpNoTemp - 1;
|
||||
}
|
||||
break;
|
||||
}
|
||||
//==================================================================================================================================================================
|
||||
//Processing later information
|
||||
//==================================================================================================================================================================
|
||||
EndBytePos = BumpNoTemp / 3;
|
||||
EndRGBPos = BumpNoTemp % 3;
|
||||
Counter = 1; //Previous [0], [1] store the data of the first SEG
|
||||
if (EndBytePos >= 1) { // Process complete
|
||||
//So far there are several complete RGB (16bit) data
|
||||
for (Temp_I = 1; Temp_I <= EndBytePos; Temp_I++) {
|
||||
IconRamMap[IconData[IconNo].DriverNo][StartBytePos + Temp_I] = SetRGB_Value(IconLevel);
|
||||
Counter = Counter + 1;
|
||||
SendDataBuffer[Counter] = (IconRamMap[IconData[IconNo].DriverNo][StartBytePos + Temp_I] & 0xFF00) >> 8; //Save High byte data in the following Buffer
|
||||
Counter = Counter + 1;
|
||||
SendDataBuffer[Counter] = IconRamMap[IconData[IconNo].DriverNo][StartBytePos + Temp_I] & 0xFF; //Save Low byte data in the following Buffer
|
||||
}
|
||||
if (EndRGBPos == 0) {
|
||||
//If there is no remainder, there is no need to process the remaining R, G, B bits. After exiting the entire batch of data, exit.
|
||||
IIC_Write_Data1(IIC_Addr[IconData[IconNo].DriverNo], Counter + 1, SendDataBuffer);
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
//=================================================================================================================================================================
|
||||
//Check the remaining number of Bits
|
||||
switch (EndRGBPos) {
|
||||
case 1: //Location in R
|
||||
IconRamMap[IconData[IconNo].DriverNo][StartBytePos + EndBytePos + 1] = ChangeRedValue(IconRamMap[IconData[IconNo].DriverNo][StartBytePos + EndBytePos + 1], IconLevel);
|
||||
break;
|
||||
case 2: //Location in G
|
||||
IconRamMap[IconData[IconNo].DriverNo][StartBytePos + EndBytePos + 1] = ChangeRG_Value(IconRamMap[IconData[IconNo].DriverNo][StartBytePos + EndBytePos + 1], IconLevel);
|
||||
break;
|
||||
}
|
||||
Counter = Counter + 1;
|
||||
//With this last data send out
|
||||
SendDataBuffer[Counter] = (IconRamMap[IconData[IconNo].DriverNo][StartBytePos + EndBytePos + 1] & 0xFF00) >> 8;
|
||||
Counter = Counter + 1;
|
||||
SendDataBuffer[Counter] = IconRamMap[IconData[IconNo].DriverNo][StartBytePos + EndBytePos + 1] & 0xFF;
|
||||
IIC_Write_Data1(IIC_Addr[IconData[IconNo].DriverNo], Counter + 1, SendDataBuffer);
|
||||
|
||||
}
|
||||
|
||||
uint16_t ChangeRedValue(uint16_t OriginalValue, uint16_t R_Value) {
|
||||
uint16_t Temp;
|
||||
|
||||
if (R_Value > 31) return 0; //If R value is greater than 31, return 0
|
||||
|
||||
Temp = OriginalValue & 0x7FF; //Clear R (high 5 bits) to 0
|
||||
Temp = Temp | (R_Value << 11); //Set R new value back
|
||||
return Temp;
|
||||
}
|
||||
|
||||
uint16_t ChangeGreenValue(uint16_t OriginalValue, uint16_t G_Value) {
|
||||
uint16_t Temp;
|
||||
|
||||
if (G_Value > 31) return 0; //If the G value is greater than 31, return 0
|
||||
|
||||
Temp = OriginalValue & 0xF81F; //Clear the G value (6 bits) to 0
|
||||
Temp = Temp | (G_Value << 6); //Set G high 5bit new value back
|
||||
|
||||
if (G_Value > 0x0f)
|
||||
Temp = Temp | 0x20; //Set bit0 of G to 1
|
||||
else
|
||||
Temp = Temp & 0xFFDF; //Set bit0 of G to 0
|
||||
|
||||
return Temp;
|
||||
}
|
||||
|
||||
uint16_t ChangeBlueValue(uint16_t OriginalValue, uint16_t B_Value) {
|
||||
uint16_t Temp;
|
||||
|
||||
if (B_Value > 31) return 0; //If the B value is greater than 31, then return 0
|
||||
Temp = OriginalValue & 0xFFE0; //Clear the B value (5 bits) to 0
|
||||
Temp = Temp | B_Value; //Set the new value of B 5bit back
|
||||
return Temp;
|
||||
}
|
||||
|
||||
uint16_t ChangeRG_Value(uint16_t OriginalValue, uint16_t RG_Value) {
|
||||
uint16_t Temp;
|
||||
|
||||
if (RG_Value > 31) return 0; //If the value is greater than 31, return 0
|
||||
Temp = OriginalValue & 0x1F; //Clear the RG value (11 bits) to 0
|
||||
Temp = Temp | (RG_Value << 11) | (RG_Value << 6); //Set R 5bit, G 6bit new value back
|
||||
if (RG_Value > 0x0f)
|
||||
Temp = Temp | 0x20; //Set bit0 of G to 1
|
||||
else
|
||||
Temp = Temp & 0xFFDF; //Set bit0 of G to 0
|
||||
|
||||
return Temp;
|
||||
}
|
||||
|
||||
uint16_t ChangeGB_Value(uint16_t OriginalValue, uint16_t GB_Value) {
|
||||
uint16_t Temp;
|
||||
|
||||
if (GB_Value > 31) return 0; //If the value is greater than 31, return 0
|
||||
Temp = OriginalValue & 0xF800; //Clear the GB value (11 bits) to 0
|
||||
Temp = Temp | (GB_Value << 6) | GB_Value; //Set G 6bit, B 5bit new value back
|
||||
if (GB_Value > 0x0f)
|
||||
Temp = Temp | 0x20; //Set bit0 of G to 1
|
||||
else
|
||||
Temp = Temp & 0xFFDF; //Set bit0 of G to 0
|
||||
|
||||
return Temp;
|
||||
}
|
||||
|
||||
uint16_t SetRGB_Value(uint16_t RGB_Value) {
|
||||
uint16_t Temp;
|
||||
|
||||
if (RGB_Value > 31) return 0; //If the value is greater than 31, return 0
|
||||
Temp = (RGB_Value << 11) | (RGB_Value << 6) | RGB_Value;
|
||||
|
||||
if (RGB_Value > 0x0f)
|
||||
Temp = Temp | 0x20; //Set bit0 of G to 1
|
||||
else
|
||||
Temp = Temp & 0xFFDF; //Set bit0 of G to 0
|
||||
|
||||
return Temp;
|
||||
}
|
||||
|
||||
void NumericalTo4BCD(uint16_t S_Number, uint8_t * BCD_Ptr) {
|
||||
uint8_t i;
|
||||
uint16_t Quotient;
|
||||
uint16_t QuotienNav;
|
||||
|
||||
Quotient = S_Number;
|
||||
for (i = 0; i <= 3; i++) {
|
||||
QuotienNav = Quotient / 10;
|
||||
BCD_Ptr[i] = Quotient % 10;
|
||||
Quotient = QuotienNav;
|
||||
}
|
||||
}
|
||||
|
||||
//=======================================================================================================
|
||||
//The following for HUD231 standard products
|
||||
//=======================================================================================================
|
||||
|
||||
#define GET_MACRO(_1,_2,_3,_4,_5,_6,_7,_8,_9,_A,_B,NAME,...) NAME
|
||||
#define AdjustIconsOn(...) GET_MACRO(__VA_ARGS__,AIOnB,AIOnA,AIOn9,AIOn8,AIOn7,AIOn6,AIOn5,AIOn4,AIOn3,AIOn2)(__VA_ARGS__)
|
||||
#define AdjustIconsOfff(...) GET_MACRO(__VA_ARGS__,AIOffB,AIOffA,AIOff9,AIOff8,AIOff7,AIOff6,AIOff5,AIOff4,AIOff3,AIOff2)(__VA_ARGS__)
|
||||
|
||||
#define AIOn2(a, b) AIOn(a); AIOn(b)
|
||||
#define AIOn3(a, b, c) AIOn(a); AIOn(b); AIOn(c)
|
||||
#define AIOn4(a, b, c, d) AIOn(a); AIOn(b); AIOn(c); AIOn(d)
|
||||
#define AIOn5(a, b, c, d, e) AIOn(a); AIOn(b); AIOn(c); AIOn(d); AIOn(e)
|
||||
#define AIOn6(a, b, c, d, e, f) AIOn(a); AIOn(b); AIOn(c); AIOn(d); AIOn(e); AIOn(f)
|
||||
#define AIOn7(a, b, c, d, e, f, g) AIOn(a); AIOn(b); AIOn(c); AIOn(d); AIOn(e); AIOn(f); AIOn(g)
|
||||
#define AIOn8(a, b, c, d, e, f, g, h) AIOn(a); AIOn(b); AIOn(c); AIOn(d); AIOn(e); AIOn(f); AIOn(g); AIOn(h)
|
||||
#define AIOn9(a, b, c, d, e, f, g, h, i) AIOn(a); AIOn(b); AIOn(c); AIOn(d); AIOn(e); AIOn(f); AIOn(g); AIOn(h); AIOn(i)
|
||||
#define AIOnA(a, b, c, d, e, f, g, h, i, j) AIOn(a); AIOn(b); AIOn(c); AIOn(d); AIOn(e); AIOn(f); AIOn(g); AIOn(h); AIOn(i); AIOn(j)
|
||||
#define AIOnB(a, b, c, d, e, f, g, h, i, j, k) AIOn(a); AIOn(b); AIOn(c); AIOn(d); AIOn(e); AIOn(f); AIOn(g); AIOn(h); AIOn(i); AIOn(j); AIOn(k)
|
||||
|
||||
#define AIOff2(a, b) AIoff(a); AIoff(b)
|
||||
#define AIOff3(a, b, c) AIoff(a); AIoff(b); AIoff(c)
|
||||
#define AIOff4(a, b, c, d) AIoff(a); AIoff(b); AIoff(c); AIoff(d)
|
||||
#define AIOff5(a, b, c, d, e) AIoff(a); AIoff(b); AIoff(c); AIoff(d); AIoff(e)
|
||||
#define AIOff6(a, b, c, d, e, f) AIoff(a); AIoff(b); AIoff(c); AIoff(d); AIoff(e); AIoff(f)
|
||||
#define AIOff7(a, b, c, d, e, f, g) AIoff(a); AIoff(b); AIoff(c); AIoff(d); AIoff(e); AIoff(f); AIoff(g)
|
||||
#define AIOff8(a, b, c, d, e, f, g, h) AIoff(a); AIoff(b); AIoff(c); AIoff(d); AIoff(e); AIoff(f); AIoff(g); AIoff(h)
|
||||
#define AIOff9(a, b, c, d, e, f, g, h, i) AIoff(a); AIoff(b); AIoff(c); AIoff(d); AIoff(e); AIoff(f); AIoff(g); \AIoff(h); AIoff(i)
|
||||
#define AIOffA(a, b, c, d, e, f, g, h, i, j) AIoff(a); AIoff(b); AIoff(c); AIoff(d); AIoff(e); AIoff(f); AIoff(g); AIoff(h); AIoff(i); AIoff(j)
|
||||
#define AIOffB(a, b, c, d, e, f, g, h, i, j, k) AIoff(a); AIoff(b); AIoff(c); AIoff(d); AIoff(e); AIoff(f); AIoff(g); AIoff(h); AIoff(i); AIoff(j); AIoff(k)
|
||||
|
||||
void AIOn(uint16_t IconNo) {
|
||||
AdjustIconLevel(IconNo, IconData[IconNo].Level);
|
||||
}
|
||||
|
||||
void AIoff(uint16_t IconNo) {
|
||||
AdjustIconLevel(IconNo, 0x00);
|
||||
}
|
||||
|
||||
void AdjustIconAction(uint16_t IconNo, bool Action) {
|
||||
if (Action) {
|
||||
AIOn(IconNo);
|
||||
} else {
|
||||
AIoff(IconNo);
|
||||
}
|
||||
}
|
||||
|
||||
#define D01(Action) AdjustIconAction(0, Action)
|
||||
#define D02(Action) AdjustIconAction(2, Action)
|
||||
#define D03(Action) AdjustIconAction(4, Action)
|
||||
#define D04(Action) AdjustIconAction(9, Action)
|
||||
#define D05(Action) AdjustIconAction(18, Action)
|
||||
#define D06(Action) AdjustIconAction(26, Action)
|
||||
#define D07(Action) AdjustIconAction(29, Action)
|
||||
#define D08(Action) AdjustIconAction(31, Action)
|
||||
|
||||
#define D0A(a, b, c, d, e, f, g, h) D01(a); D02(b); D03(c); D04(d); D05(e); D06(f); D07(g); D08(h)
|
||||
|
||||
#define CC1(Action) AdjustIconAction(1, Action)
|
||||
#define CC2(Action) AdjustIconAction(3, Action)
|
||||
#define CC3(Action) AdjustIconAction(5, Action)
|
||||
#define CC4(Action) AdjustIconAction(8, Action)
|
||||
#define CC5(Action) AdjustIconAction(17, Action)
|
||||
#define CC6(Action) AdjustIconAction(27, Action)
|
||||
#define CC7(Action) AdjustIconAction(28, Action)
|
||||
#define CC8(Action) AdjustIconAction(30, Action)
|
||||
|
||||
#define CCA(a, b, c, d, e, f, g, h) CC1(a); CC2(b); CC3(c); CC4(d); CC5(e); CC6(f); CC7(g); CC8(h)
|
||||
|
||||
//0-9 00-full off 1-8 => specify which CCx goes off 9-all bright 10-17=> specifies which CCx is on (inverse with 1-8)
|
||||
void compassCircle(uint8_t Select) {
|
||||
switch (Select) {
|
||||
case 0: CCA(0, 0, 0, 0, 0, 0, 0, 0); break;
|
||||
case 1: CCA(1, 0, 0, 0, 0, 0, 0, 0); break;
|
||||
case 2: CCA(0, 1, 0, 0, 0, 0, 0, 0); break;
|
||||
case 3: CCA(0, 0, 1, 0, 0, 0, 0, 0); break;
|
||||
case 4: CCA(0, 0, 0, 1, 0, 0, 0, 0); break;
|
||||
case 5: CCA(0, 0, 0, 0, 1, 0, 0, 0); break;
|
||||
case 6: CCA(0, 0, 0, 0, 0, 1, 0, 0); break;
|
||||
case 7: CCA(0, 0, 0, 0, 0, 0, 1, 0); break;
|
||||
case 8: CCA(0, 0, 0, 0, 0, 0, 0, 1); break;
|
||||
case 9: CCA(1, 1, 1, 1, 1, 1, 1, 1); break;
|
||||
case 10: CCA(0, 1, 1, 1, 1, 1, 1, 1); break;
|
||||
case 11: CCA(1, 0, 1, 1, 1, 1, 1, 1); break;
|
||||
case 12: CCA(1, 1, 0, 1, 1, 1, 1, 1); break;
|
||||
case 13: CCA(1, 1, 1, 0, 1, 1, 1, 1); break;
|
||||
case 14: CCA(1, 1, 1, 1, 0, 1, 1, 1); break;
|
||||
case 15: CCA(1, 1, 1, 1, 1, 0, 1, 1); break;
|
||||
case 16: CCA(1, 1, 1, 1, 1, 1, 0, 1); break;
|
||||
case 17: CCA(1, 1, 1, 1, 1, 1, 1, 0); break;
|
||||
}
|
||||
}
|
||||
|
||||
void D0x(uint8_t Action) {
|
||||
if (Action) {
|
||||
D01(1); D02(1); D03(1); D04(1); D05(1); D06(1); D07(1); D08(1);
|
||||
} else {
|
||||
D01(0); D02(0); D03(0); D04(0); D05(0); D06(0); D07(0); D08(0);
|
||||
}
|
||||
}
|
||||
|
||||
//0-9 00-full off 1-8 => specify which one is off D0x 9-all bright 10-17=> specify which one D0x is on (inverse with 1-8)
|
||||
void compassArrows(uint8_t Select) {
|
||||
switch (Select) {
|
||||
case 0: D0A(0, 0, 0, 0, 0, 0, 0, 0); break;
|
||||
case 1: D0A(1, 0, 0, 0, 0, 0, 0, 0); break;
|
||||
case 2: D0A(0, 1, 0, 0, 0, 0, 0, 0); break;
|
||||
case 3: D0A(0, 0, 1, 0, 0, 0, 0, 0); break;
|
||||
case 4: D0A(0, 0, 0, 1, 0, 0, 0, 0); break;
|
||||
case 5: D0A(0, 0, 0, 0, 1, 0, 0, 0); break;
|
||||
case 6: D0A(0, 0, 0, 0, 0, 1, 0, 0); break;
|
||||
case 7: D0A(0, 0, 0, 0, 0, 0, 1, 0); break;
|
||||
case 8: D0A(0, 0, 0, 0, 0, 0, 0, 1); break;
|
||||
case 9: D0A(1, 1, 1, 1, 1, 1, 1, 1); break;
|
||||
case 10: D0A(0, 1, 1, 1, 1, 1, 1, 1); break;
|
||||
case 11: D0A(1, 0, 1, 1, 1, 1, 1, 1); break;
|
||||
case 12: D0A(1, 1, 0, 1, 1, 1, 1, 1); break;
|
||||
case 13: D0A(1, 1, 1, 0, 1, 1, 1, 1); break;
|
||||
case 14: D0A(1, 1, 1, 1, 0, 1, 1, 1); break;
|
||||
case 15: D0A(1, 1, 1, 1, 1, 0, 1, 1); break;
|
||||
case 16: D0A(1, 1, 1, 1, 1, 1, 0, 1); break;
|
||||
case 17: D0A(1, 1, 1, 1, 1, 1, 1, 0); break;
|
||||
}
|
||||
}
|
||||
|
||||
#define radarDistanceUnits(Action) AdjustIconAction(80, Action)
|
||||
|
||||
#define flag(Action) AdjustIconAction(32, Action)
|
||||
|
||||
#define C01(Action) AdjustIconAction(40, Action)
|
||||
#define C02(Action) AdjustIconAction(48, Action)
|
||||
#define H01(Action) AdjustIconAction(58, Action)
|
||||
#define K01(Action) AdjustIconAction(56, Action)
|
||||
#define M01(Action) AdjustIconAction(57, Action)
|
||||
#define C03(Action) AdjustIconAction(145, Action)
|
||||
#define K02(Action) AdjustIconAction(153, Action)
|
||||
#define M03(Action) AdjustIconAction(154, Action)
|
||||
#define P01(Action) AdjustIconAction(211, Action)
|
||||
#define P02(Action) AdjustIconAction(212, Action)
|
||||
#define P03(Action) AdjustIconAction(213, Action)
|
||||
#define T01(Action) AdjustIconAction(189, Action)
|
||||
#define T02(Action) AdjustIconAction(197, Action)
|
||||
|
||||
void tirePressureAlert(uint8_t Action) {
|
||||
|
||||
switch (Action) {
|
||||
case 0: // Blank
|
||||
T01(0); // "tire"
|
||||
T02(0); // "TPMS"
|
||||
break;
|
||||
case 1: // TPMS
|
||||
T01(0); // "tire"
|
||||
T02(1); // "TPMS"
|
||||
break;
|
||||
case 2: // Tire
|
||||
T01(1); // "tire"
|
||||
T02(0); // "TPMS"
|
||||
break;
|
||||
case 3: // Both
|
||||
T01(1); // "tire"
|
||||
T02(1); // "TPMS"
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
#define speedometerUnits(Action) AdjustIconAction(230, Action)
|
||||
|
||||
void destinationDistanceUnits(uint8_t iconUnits) {
|
||||
|
||||
switch (iconUnits) {
|
||||
|
||||
case 0: // Blank
|
||||
H01(0); // hours
|
||||
K01(0); // kilo
|
||||
M01(0); // meters
|
||||
break;
|
||||
case 1: // hours
|
||||
H01(1); // hours
|
||||
K01(0); // kilo
|
||||
M01(0); // meters
|
||||
break;
|
||||
case 2: // meters
|
||||
H01(0); // hours
|
||||
K01(0); // kilo
|
||||
M01(1); // meters
|
||||
break;
|
||||
case 3: // kilometers
|
||||
H01(0); // hours
|
||||
K01(1); // kilo
|
||||
M01(1); // meters
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void turnDistanceUnits(uint8_t iconUnits) {
|
||||
|
||||
switch (iconUnits) {
|
||||
|
||||
case 0: // Blank
|
||||
K02(0); // kilo
|
||||
M03(0); // meters
|
||||
break;
|
||||
case 1: // meters
|
||||
K02(0); // kilo
|
||||
M03(1); // meters
|
||||
break;
|
||||
case 2: // kilometers
|
||||
K02(1); // kilo
|
||||
M03(1); // meters
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void leftTunnel(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(91, 92, 93, 94, 95, 96, 97, 98, 99);
|
||||
} else {
|
||||
AdjustIconsOff(91, 92, 93, 94, 95, 96, 97, 98, 99);
|
||||
}
|
||||
}
|
||||
|
||||
void middleTunnel(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(89, 90, 100, 101, 102, 198, 199, 209, 210);
|
||||
} else {
|
||||
AdjustIconsOff(89, 90, 100, 101, 102, 198, 199, 209, 210);
|
||||
}
|
||||
}
|
||||
|
||||
void rightTunnel(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(200, 201, 202, 203, 204, 205, 206, 207, 208);
|
||||
} else {
|
||||
AdjustIconsOff(200, 201, 202, 203, 204, 205, 206, 207, 208);
|
||||
}
|
||||
}
|
||||
|
||||
void leftRoad(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(91, 94, 95, 99);
|
||||
} else {
|
||||
AdjustIconsOff(91, 94, 95, 99);
|
||||
}
|
||||
}
|
||||
|
||||
void middleRoad(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(90, 100, 199, 209);
|
||||
} else {
|
||||
AdjustIconsOff(90, 100, 199, 209);
|
||||
}
|
||||
}
|
||||
|
||||
void rightRoad(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(200, 204, 205, 208);
|
||||
} else {
|
||||
AdjustIconsOff(200, 204, 205, 208);
|
||||
}
|
||||
}
|
||||
|
||||
void nav_Group(uint8_t Action) {
|
||||
uint8_t i;
|
||||
|
||||
if (Action) {
|
||||
for (i = 103; i <= 130; i++) {
|
||||
AdjustIconLevel(i, IconData[i].Level);
|
||||
}
|
||||
for (i = 155; i <= 181; i++) {
|
||||
AdjustIconLevel(i, IconData[i].Level);
|
||||
}
|
||||
} else {
|
||||
for (i = 103; i <= 130; i++) {
|
||||
AdjustIconLevel(i, 0x00);
|
||||
}
|
||||
for (i = 155; i <= 181; i++) {
|
||||
AdjustIconLevel(i, 0x00);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void nav_KeepLeft(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(107, 108, 109, 106, 111, 112, 105, 128, 129, 155, 130);
|
||||
} else {
|
||||
AdjustIconsOff(107, 108, 109, 106, 111, 112, 105, 128, 129, 155, 130);
|
||||
}
|
||||
}
|
||||
|
||||
void nav_TurnLeft(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(113, 114, 121, 111, 112, 115, 128, 129, 155, 130);
|
||||
} else {
|
||||
AdjustIconsOff(113, 114, 121, 111, 112, 115, 128, 129, 155, 130);
|
||||
}
|
||||
}
|
||||
|
||||
void nav_TurnRight(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(171, 170, 163, 173, 172, 169, 156, 129, 155, 130);
|
||||
} else {
|
||||
AdjustIconsOff(171, 170, 163, 173, 172, 169, 156, 129, 155, 130);
|
||||
}
|
||||
}
|
||||
|
||||
void nav_HardRight(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(165, 159, 163, 160, 158, 166, 156, 129, 155, 130);
|
||||
} else {
|
||||
AdjustIconsOff(165, 159, 163, 160, 158, 166, 156, 129, 155, 130);
|
||||
}
|
||||
}
|
||||
|
||||
void nav_HardLeft(uint8_t Action) {
|
||||
if (Action) {
|
||||
AdjustIconsOn(119, 125, 121, 124, 126, 118, 128, 129, 155, 130);
|
||||
} else {
|
||||
AdjustIconsOff(119, 125, 121, 124, 126, 118, 128, 129, 155, 130);
|
||||
}
|
||||
}
|
||||
|
||||
void nav_UTurnLeft(uint8_t Action) {
|
||||
|
||||
if (Action) {
|
||||
AdjustIconLevel(162, IconData[162].Level);
|
||||
AdjustIconLevel(166, IconData[166].Level);
|
||||
AdjustIconLevel(167, IconData[167].Level);
|
||||
AdjustIconLevel(168, IconData[168].Level);
|
||||
AdjustIconLevel(170, IconData[170].Level);
|
||||
AdjustIconLevel(174, IconData[174].Level);
|
||||
AdjustIconLevel(176, IconData[176].Level);
|
||||
AdjustIconLevel(179, IconData[179].Level);
|
||||
AdjustIconLevel(180, IconData[180].Level);
|
||||
AdjustIconLevel(104, IconData[104].Level);
|
||||
AdjustIconLevel(108, IconData[108].Level);
|
||||
AdjustIconLevel(110, IconData[110].Level);
|
||||
AdjustIconLevel(114, IconData[114].Level);
|
||||
AdjustIconLevel(116, IconData[116].Level);
|
||||
AdjustIconLevel(117, IconData[117].Level);
|
||||
AdjustIconLevel(118, IconData[118].Level);
|
||||
AdjustIconLevel(122, IconData[122].Level);
|
||||
AdjustIconLevel(123, IconData[123].Level);
|
||||
|
||||
} else {
|
||||
AdjustIconLevel(162, 0x00);
|
||||
AdjustIconLevel(166, 0x00);
|
||||
AdjustIconLevel(167, 0x00);
|
||||
AdjustIconLevel(168, 0x00);
|
||||
AdjustIconLevel(170, 0x00);
|
||||
AdjustIconLevel(174, 0x00);
|
||||
AdjustIconLevel(176, 0x00);
|
||||
AdjustIconLevel(179, 0x00);
|
||||
AdjustIconLevel(180, 0x00);
|
||||
AdjustIconLevel(104, 0x00);
|
||||
AdjustIconLevel(108, 0x00);
|
||||
AdjustIconLevel(110, 0x00);
|
||||
AdjustIconLevel(114, 0x00);
|
||||
AdjustIconLevel(116, 0x00);
|
||||
AdjustIconLevel(117, 0x00);
|
||||
AdjustIconLevel(118, 0x00);
|
||||
AdjustIconLevel(122, 0x00);
|
||||
AdjustIconLevel(123, 0x00);
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
void nav_UTurnRight(uint8_t Action) {
|
||||
|
||||
if (Action) {
|
||||
AdjustIconLevel(162, IconData[162].Level);
|
||||
AdjustIconLevel(166, IconData[166].Level);
|
||||
AdjustIconLevel(167, IconData[167].Level);
|
||||
AdjustIconLevel(168, IconData[168].Level);
|
||||
AdjustIconLevel(170, IconData[170].Level);
|
||||
AdjustIconLevel(174, IconData[174].Level);
|
||||
AdjustIconLevel(176, IconData[176].Level);
|
||||
AdjustIconLevel(179, IconData[179].Level);
|
||||
AdjustIconLevel(180, IconData[180].Level);
|
||||
AdjustIconLevel(104, IconData[104].Level);
|
||||
AdjustIconLevel(108, IconData[108].Level);
|
||||
AdjustIconLevel(110, IconData[110].Level);
|
||||
AdjustIconLevel(114, IconData[114].Level);
|
||||
AdjustIconLevel(116, IconData[116].Level);
|
||||
AdjustIconLevel(117, IconData[117].Level);
|
||||
AdjustIconLevel(118, IconData[118].Level);
|
||||
AdjustIconLevel(122, IconData[122].Level);
|
||||
AdjustIconLevel(161, IconData[161].Level);
|
||||
|
||||
} else {
|
||||
AdjustIconLevel(162, 0x00);
|
||||
AdjustIconLevel(166, 0x00);
|
||||
AdjustIconLevel(167, 0x00);
|
||||
AdjustIconLevel(168, 0x00);
|
||||
AdjustIconLevel(170, 0x00);
|
||||
AdjustIconLevel(174, 0x00);
|
||||
AdjustIconLevel(176, 0x00);
|
||||
AdjustIconLevel(179, 0x00);
|
||||
AdjustIconLevel(180, 0x00);
|
||||
AdjustIconLevel(104, 0x00);
|
||||
AdjustIconLevel(108, 0x00);
|
||||
AdjustIconLevel(110, 0x00);
|
||||
AdjustIconLevel(114, 0x00);
|
||||
AdjustIconLevel(116, 0x00);
|
||||
AdjustIconLevel(117, 0x00);
|
||||
AdjustIconLevel(118, 0x00);
|
||||
AdjustIconLevel(122, 0x00);
|
||||
AdjustIconLevel(161, 0x00);
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
void nav_ContinueStraight(uint8_t Action) {
|
||||
// uint8_t i;
|
||||
|
||||
if (Action) {
|
||||
AdjustIconLevel(181, IconData[181].Level);
|
||||
AdjustIconLevel(180, IconData[180].Level);
|
||||
AdjustIconLevel(103, IconData[103].Level);
|
||||
AdjustIconLevel(178, IconData[178].Level);
|
||||
AdjustIconLevel(105, IconData[105].Level);
|
||||
AdjustIconLevel(106, IconData[106].Level);
|
||||
AdjustIconLevel(173, IconData[173].Level);
|
||||
AdjustIconLevel(111, IconData[111].Level);
|
||||
AdjustIconLevel(129, IconData[129].Level);
|
||||
AdjustIconLevel(155, IconData[155].Level);
|
||||
AdjustIconLevel(130, IconData[130].Level);
|
||||
} else {
|
||||
AdjustIconLevel(181, 0x00);
|
||||
AdjustIconLevel(180, 0x00);
|
||||
AdjustIconLevel(103, 0x00);
|
||||
AdjustIconLevel(178, 0x00);
|
||||
AdjustIconLevel(105, 0x00);
|
||||
AdjustIconLevel(106, 0x00);
|
||||
AdjustIconLevel(173, 0x00);
|
||||
AdjustIconLevel(111, 0x00);
|
||||
AdjustIconLevel(129, 0x00);
|
||||
AdjustIconLevel(155, 0x00);
|
||||
AdjustIconLevel(130, 0x00);
|
||||
}
|
||||
}
|
||||
|
||||
void nav_KeepRight(uint8_t Action) {
|
||||
// uint8_t i;
|
||||
|
||||
if (Action) {
|
||||
AdjustIconLevel(105, IconData[105].Level);
|
||||
AdjustIconLevel(177, IconData[177].Level);
|
||||
AdjustIconLevel(176, IconData[176].Level);
|
||||
AdjustIconLevel(175, IconData[175].Level);
|
||||
AdjustIconLevel(172, IconData[172].Level);
|
||||
AdjustIconLevel(173, IconData[173].Level);
|
||||
AdjustIconLevel(178, IconData[178].Level);
|
||||
AdjustIconLevel(156, IconData[156].Level);
|
||||
AdjustIconLevel(129, IconData[129].Level);
|
||||
AdjustIconLevel(155, IconData[155].Level);
|
||||
AdjustIconLevel(130, IconData[130].Level);
|
||||
} else {
|
||||
AdjustIconLevel(105, 0x00);
|
||||
AdjustIconLevel(177, 0x00);
|
||||
AdjustIconLevel(176, 0x00);
|
||||
AdjustIconLevel(175, 0x00);
|
||||
AdjustIconLevel(172, 0x00);
|
||||
AdjustIconLevel(173, 0x00);
|
||||
AdjustIconLevel(178, 0x00);
|
||||
AdjustIconLevel(156, 0x00);
|
||||
AdjustIconLevel(129, 0x00);
|
||||
AdjustIconLevel(155, 0x00);
|
||||
AdjustIconLevel(130, 0x00);
|
||||
}
|
||||
}
|
||||
|
||||
void radarDetector(uint8_t Level) //00-08 00-全滅 01-主體 02-08 =>Level
|
||||
{
|
||||
switch (Level) {
|
||||
case 0:
|
||||
AdjustIconLevel(81, 0x00); //R01
|
||||
AdjustIconLevel(82, 0x00); //R02
|
||||
AdjustIconLevel(83, 0x00); //R03
|
||||
AdjustIconLevel(84, 0x00); //R04
|
||||
AdjustIconLevel(85, 0x00); //R05
|
||||
AdjustIconLevel(86, 0x00); //R06
|
||||
AdjustIconLevel(87, 0x00); //R07
|
||||
AdjustIconLevel(88, 0x00); //R08
|
||||
break;
|
||||
case 1:
|
||||
AdjustIconLevel(81, IconData[81].Level); //R01
|
||||
AdjustIconLevel(82, 0x00); //R02
|
||||
AdjustIconLevel(83, 0x00); //R03
|
||||
AdjustIconLevel(84, 0x00); //R04
|
||||
AdjustIconLevel(85, 0x00); //R05
|
||||
AdjustIconLevel(86, 0x00); //R06
|
||||
AdjustIconLevel(87, 0x00); //R07
|
||||
AdjustIconLevel(88, 0x00); //R08
|
||||
break;
|
||||
case 2:
|
||||
AdjustIconLevel(81, IconData[81].Level); //R01
|
||||
AdjustIconLevel(82, IconData[82].Level); //R02
|
||||
AdjustIconLevel(83, 0x00); //R03
|
||||
AdjustIconLevel(84, 0x00); //R04
|
||||
AdjustIconLevel(85, 0x00); //R05
|
||||
AdjustIconLevel(86, 0x00); //R06
|
||||
AdjustIconLevel(87, 0x00); //R07
|
||||
AdjustIconLevel(88, 0x00); //R08
|
||||
break;
|
||||
case 3:
|
||||
AdjustIconLevel(81, IconData[81].Level); //R01
|
||||
AdjustIconLevel(82, IconData[82].Level); //R02
|
||||
AdjustIconLevel(83, IconData[83].Level); //R03
|
||||
AdjustIconLevel(84, 0x00); //R04
|
||||
AdjustIconLevel(85, 0x00); //R05
|
||||
AdjustIconLevel(86, 0x00); //R06
|
||||
AdjustIconLevel(87, 0x00); //R07
|
||||
AdjustIconLevel(88, 0x00); //R08
|
||||
break;
|
||||
case 4:
|
||||
AdjustIconLevel(81, IconData[81].Level); //R01
|
||||
AdjustIconLevel(82, IconData[82].Level); //R02
|
||||
AdjustIconLevel(83, IconData[83].Level); //R03
|
||||
AdjustIconLevel(84, IconData[84].Level); //R04
|
||||
AdjustIconLevel(85, 0x00); //R05
|
||||
AdjustIconLevel(86, 0x00); //R06
|
||||
AdjustIconLevel(87, 0x00); //R07
|
||||
AdjustIconLevel(88, 0x00); //R08
|
||||
break;
|
||||
case 5:
|
||||
AdjustIconLevel(81, IconData[81].Level); //R01
|
||||
AdjustIconLevel(82, IconData[82].Level); //R02
|
||||
AdjustIconLevel(83, IconData[83].Level); //R03
|
||||
AdjustIconLevel(84, IconData[84].Level); //R04
|
||||
AdjustIconLevel(85, IconData[85].Level); //R05
|
||||
AdjustIconLevel(86, 0x00); //R06
|
||||
AdjustIconLevel(87, 0x00); //R07
|
||||
AdjustIconLevel(88, 0x00); //R08
|
||||
break;
|
||||
case 6:
|
||||
AdjustIconLevel(81, IconData[81].Level); //R01
|
||||
AdjustIconLevel(82, IconData[82].Level); //R02
|
||||
AdjustIconLevel(83, IconData[83].Level); //R03
|
||||
AdjustIconLevel(84, IconData[84].Level); //R04
|
||||
AdjustIconLevel(85, IconData[85].Level); //R05
|
||||
AdjustIconLevel(86, IconData[86].Level); //R06
|
||||
AdjustIconLevel(87, 0x00); //R07
|
||||
AdjustIconLevel(88, 0x00); //R08
|
||||
break;
|
||||
case 7:
|
||||
AdjustIconLevel(81, IconData[81].Level); //R01
|
||||
AdjustIconLevel(82, IconData[82].Level); //R02
|
||||
AdjustIconLevel(83, IconData[83].Level); //R03
|
||||
AdjustIconLevel(84, IconData[84].Level); //R04
|
||||
AdjustIconLevel(85, IconData[85].Level); //R05
|
||||
AdjustIconLevel(86, IconData[86].Level); //R06
|
||||
AdjustIconLevel(87, IconData[87].Level); //R07
|
||||
AdjustIconLevel(88, 0x00); //R08
|
||||
break;
|
||||
case 8:
|
||||
AdjustIconLevel(81, IconData[81].Level); //R01
|
||||
AdjustIconLevel(82, IconData[82].Level); //R02
|
||||
AdjustIconLevel(83, IconData[83].Level); //R03
|
||||
AdjustIconLevel(84, IconData[84].Level); //R04
|
||||
AdjustIconLevel(85, IconData[85].Level); //R05
|
||||
AdjustIconLevel(86, IconData[86].Level); //R06
|
||||
AdjustIconLevel(87, IconData[87].Level); //R07
|
||||
AdjustIconLevel(88, IconData[88].Level); //R08
|
||||
break;
|
||||
};
|
||||
}
|
||||
|
||||
void DispNumber(const uint16_t * SegIconPtr, uint8_t DispNo) {
|
||||
uint8_t Cnt;
|
||||
uint16_t tmp;
|
||||
uint32_t DispData;
|
||||
|
||||
DispData = NumberSegTable[DispNo];
|
||||
Cnt = 0;
|
||||
do {
|
||||
tmp = SegIconPtr[Cnt];
|
||||
if ((tmp != 0) && ((DispData & 1) == 1)) {
|
||||
AdjustIconLevel(tmp, IconData[tmp].Level);
|
||||
} else {
|
||||
AdjustIconLevel(tmp, 0x00);
|
||||
}
|
||||
DispData >>= 1;
|
||||
Cnt++;
|
||||
} while (Cnt <= 6);
|
||||
}
|
||||
|
||||
void setSegmentedDisplay(uint8_t Display, uint8_t SpeedNo, bool Mode) {
|
||||
uint8_t BCDcode[4];
|
||||
|
||||
if (SpeedNo > DisplayLimit[Display])
|
||||
SpeedNo = DisplayLimit[Display];
|
||||
|
||||
NumericalTo4BCD(SpeedNo, BCDcode);
|
||||
|
||||
if (BCDcode[2] == 0 && BCDcode[1] == 0 && Mode) {
|
||||
DispNumber(SegIconTable[Display][0], 10);
|
||||
} else {
|
||||
DispNumber(SegIconTable[Display][0], BCDcode[2]);
|
||||
}
|
||||
if (BCDcode[2] == 0 && Mode) {
|
||||
DispNumber(SegIconTable[Display][1], 10);
|
||||
} else {
|
||||
DispNumber(SegIconTable[Display][1], BCDcode[1]);
|
||||
}
|
||||
DispNumber(SegIconTable[Display][2], BCDcode[0]);
|
||||
|
||||
}
|
||||
|
||||
void setCallIcon(uint8_t iconStatus) {
|
||||
|
||||
switch (iconStatus) {
|
||||
case 0: // Blank
|
||||
P01(0); // Call Outline
|
||||
P02(0); // Call Phone Icon
|
||||
P03(0); // Call Text
|
||||
break;
|
||||
case 1: // Outline Only
|
||||
P01(1); // Call Outline
|
||||
P02(0); // Call Phone Icon
|
||||
P03(0); // Call Text
|
||||
break;
|
||||
case 2: // Outline w/ Phone
|
||||
P01(1); // Call Outline
|
||||
P02(1); // Call Phone Icon
|
||||
P03(0); // Call Text
|
||||
break;
|
||||
case 3: // All
|
||||
P01(1); // Call Outline
|
||||
P02(1); // Call Phone Icon
|
||||
P03(1); // Call Text
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
void SoftReset(unsigned char DriverNo) {
|
||||
ReceiveData[0] = 0x01; //SoftReset Command No.
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 1, ReceiveData);
|
||||
}
|
||||
|
||||
void SetOscControl(unsigned char DriverNo, unsigned char mode) {
|
||||
ReceiveData[0] = 0x04; //Set Osc Control Command No.
|
||||
ReceiveData[1] = mode;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 2, ReceiveData);
|
||||
}
|
||||
|
||||
void SetGraphicsRAMWritingDirection(unsigned char DriverNo, unsigned char mode) {
|
||||
ReceiveData[0] = 0x05; //Set Graphics RAM Writing Direction Command No.
|
||||
ReceiveData[1] = mode;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 2, ReceiveData);
|
||||
}
|
||||
|
||||
void SetInterface(unsigned char DriverNo, unsigned char mode) {
|
||||
ReceiveData[0] = 0x08; //Set Interface Command No.
|
||||
ReceiveData[1] = mode;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 2, ReceiveData);
|
||||
}
|
||||
|
||||
void DisplayOnOff(unsigned char DriverNo, unsigned char Val) {
|
||||
ReceiveData[0] = 0x02; //DisplayOnOff Command No.
|
||||
ReceiveData[1] = Val;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 2, ReceiveData);
|
||||
}
|
||||
|
||||
void DisplayStandbyOnOff(unsigned char DriverNo, unsigned char Val) {
|
||||
ReceiveData[0] = 0x03; //DisplayStandbyOnOff Command No.
|
||||
ReceiveData[1] = Val;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 2, ReceiveData);
|
||||
}
|
||||
|
||||
void SetDisplaySize(unsigned char DriverNo, unsigned char Xstart, unsigned char Xend, unsigned char Ystart, unsigned char Yend) {
|
||||
ReceiveData[0] = 0x07; //SetDisplaySize Command No.
|
||||
ReceiveData[1] = Xstart >> 4;
|
||||
ReceiveData[2] = Xstart & 0x0f;
|
||||
ReceiveData[3] = Xend >> 4;
|
||||
ReceiveData[4] = Xend & 0x0f;
|
||||
ReceiveData[5] = Ystart >> 4;
|
||||
ReceiveData[6] = Ystart & 0x0f;
|
||||
ReceiveData[7] = Yend >> 4;
|
||||
ReceiveData[8] = Yend & 0x0f;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 9, ReceiveData);
|
||||
}
|
||||
|
||||
void SetDotCurrent(unsigned char DriverNo, unsigned char Rlevel, unsigned char Glevel, unsigned char Blevel) {
|
||||
ReceiveData[0] = 0x0e; //SetDotCurrent Level Command No.
|
||||
ReceiveData[1] = Rlevel >> 4;
|
||||
ReceiveData[2] = Rlevel & 0x0f;
|
||||
ReceiveData[3] = Glevel >> 4;
|
||||
ReceiveData[4] = Glevel & 0x0f;
|
||||
ReceiveData[5] = Blevel >> 4;
|
||||
ReceiveData[6] = Blevel & 0x0f;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 7, ReceiveData);
|
||||
}
|
||||
|
||||
void SetSystemClockDivisionRatio(unsigned char DriverNo, unsigned char mode) {
|
||||
ReceiveData[0] = 0x10; //Set System Clock Division Ratio Command No.
|
||||
ReceiveData[1] = mode;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 2, ReceiveData);
|
||||
}
|
||||
|
||||
void SetPreChargeWidth(unsigned char DriverNo, unsigned char Val) {
|
||||
ReceiveData[0] = 0x1C; //SetPreChargeWidth Command No.
|
||||
ReceiveData[1] = Val;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 2, ReceiveData);
|
||||
}
|
||||
|
||||
void SetPeakPulseWidth(unsigned char DriverNo, unsigned char Rlevel, unsigned char Glevel, unsigned char Blevel) {
|
||||
ReceiveData[0] = 0x1d; //SetPeakPulseWidthl Command No.
|
||||
ReceiveData[1] = Rlevel >> 4;
|
||||
ReceiveData[2] = Rlevel & 0x0f;
|
||||
ReceiveData[3] = Glevel >> 4;
|
||||
ReceiveData[4] = Glevel & 0x0f;
|
||||
ReceiveData[5] = Blevel >> 4;
|
||||
ReceiveData[6] = Blevel & 0x0f;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 7, ReceiveData);
|
||||
}
|
||||
|
||||
void SetPeakPulseDelay(unsigned char DriverNo, unsigned char Val) {
|
||||
ReceiveData[0] = 0x1e; //SetPeakPulseDelay Command No.
|
||||
ReceiveData[1] = Val;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 2, ReceiveData);
|
||||
}
|
||||
|
||||
void SetRowScanOperation(unsigned char DriverNo, unsigned char mode) {
|
||||
ReceiveData[0] = 0x1f; //SetRowScanOperation Command No.
|
||||
ReceiveData[1] = mode;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 2, ReceiveData);
|
||||
}
|
||||
|
||||
void SetInternalRegulatorforRowScan(unsigned char DriverNo, unsigned char mode) {
|
||||
ReceiveData[0] = 0x30; //SetInternalRegulatorforRowScan Command No.
|
||||
ReceiveData[1] = mode;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 2, ReceiveData);
|
||||
}
|
||||
|
||||
void DumpDataToDriver(unsigned char DriverNo, unsigned int SData) {
|
||||
unsigned int Cnt, CnNav;
|
||||
unsigned char Nav, t2;
|
||||
// unsigned char tmp;
|
||||
|
||||
//Set the position setting to write Row-0
|
||||
ReceiveData[0] = 0x0a;
|
||||
ReceiveData[1] = 0x00; //X Start
|
||||
ReceiveData[2] = 0x00;
|
||||
ReceiveData[3] = 0x07; //X End
|
||||
ReceiveData[4] = 0x0f;
|
||||
ReceiveData[5] = 0x00; //Y Start
|
||||
ReceiveData[6] = 0x00;
|
||||
ReceiveData[7] = 0x00; //Y End
|
||||
ReceiveData[8] = 0x00;
|
||||
IIC_Write_Command1(IIC_Addr[DriverNo], 9, ReceiveData);
|
||||
|
||||
Nav = SData >> 8;
|
||||
t2 = SData & 0xff;
|
||||
|
||||
CnNav = 0;
|
||||
for (Cnt = 0; Cnt <= 127; Cnt++) {
|
||||
ReceiveData[CnNav] = Nav;
|
||||
CnNav++;
|
||||
ReceiveData[CnNav] = t2;
|
||||
CnNav++;
|
||||
}
|
||||
IIC_Write_Data1(IIC_Addr[DriverNo], CnNav, ReceiveData);
|
||||
}
|
||||
|
||||
//---------------------------------INITIALIZE (HUDBEGIN)-----------------------------------//
|
||||
|
||||
void initializeHUD231(void) {
|
||||
uint8_t i, j;
|
||||
|
||||
SoftReset(0);
|
||||
SoftReset(1);
|
||||
|
||||
SetOscControl(0, 3); // Internal OSC. 105hz
|
||||
SetOscControl(1, 3);
|
||||
|
||||
SetGraphicsRAMWritingDirection(0, 2); //RGB, Left->Right, Bottom->Top
|
||||
SetGraphicsRAMWritingDirection(1, 2);
|
||||
|
||||
SetSystemClockDivisionRatio(0, 0x0B); // 1/128
|
||||
SetSystemClockDivisionRatio(1, 0x0B);
|
||||
|
||||
SetInterface(0, 1);
|
||||
SetInterface(1, 1);
|
||||
|
||||
DisplayOnOff(0, 0);
|
||||
DisplayOnOff(1, 0);
|
||||
|
||||
SetDisplaySize(0, 0, 127, 0, 0);
|
||||
SetDisplaySize(1, 0, 127, 0, 0);
|
||||
|
||||
SetDotCurrent(0, 220, 230, 230);
|
||||
SetDotCurrent(1, 230, 230, 230);
|
||||
|
||||
SetPreChargeWidth(0, 1); //1
|
||||
SetPreChargeWidth(1, 1);
|
||||
|
||||
SetPeakPulseWidth(0, 0, 0, 0); //0,0,0
|
||||
SetPeakPulseWidth(1, 0, 0, 0);
|
||||
|
||||
SetPeakPulseDelay(0, 1); //1
|
||||
SetPeakPulseDelay(1, 1);
|
||||
|
||||
SetRowScanOperation(0, 0x2a); //Pre-Charge + Peak Delay Timing,All Row are in GND, Mode3
|
||||
SetRowScanOperation(1, 0x2a);
|
||||
|
||||
SetInternalRegulatorforRowScan(0, 0x10); //Internal scan requlator Enable, VCC_Cx0.85
|
||||
SetInternalRegulatorforRowScan(1, 0x10);
|
||||
|
||||
DisplayStandbyOnOff(0, 1);
|
||||
DisplayStandbyOnOff(0, 0);
|
||||
DisplayStandbyOnOff(1, 1);
|
||||
DisplayStandbyOnOff(1, 0);
|
||||
|
||||
DumpDataToDriver(0, 0x0000);
|
||||
DumpDataToDriver(1, 0x0000);
|
||||
|
||||
DisplayOnOff(0, 1);
|
||||
DisplayOnOff(1, 1);
|
||||
|
||||
for (i = 0; i < 2; i++) {
|
||||
for (j = 0; j < 128; j++) {
|
||||
IconRamMap[i][j] = 0;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
//---------------------------------I2C FUNCTIONS-----------------------------------//
|
||||
|
||||
void IIC_Write_Command1(uint8_t IIC_Addr, uint16_t DataLen, uint8_t * DataPtr) {
|
||||
uint16_t Cnt;
|
||||
|
||||
_i2cPort - > beginTransmission(IIC_Addr);
|
||||
for (Cnt = 0; Cnt < DataLen; Cnt++) {
|
||||
_i2cPort - > write(DataPtr[Cnt]);
|
||||
}
|
||||
_i2cPort - > endTransmission();
|
||||
}
|
||||
|
||||
void IIC_Write_Data1(uint8_t IIC_Addr, uint16_t DataLen, uint8_t * DataPtr) {
|
||||
uint16_t Cnt;
|
||||
|
||||
_i2cPort - > beginTransmission(IIC_Addr);
|
||||
_i2cPort - > write(0x0C);
|
||||
|
||||
for (Cnt = 0; Cnt < DataLen; Cnt++) {
|
||||
_i2cPort - > write(DataPtr[Cnt]);
|
||||
}
|
||||
_i2cPort - > endTransmission();
|
||||
}
|
||||
|
||||
void IIC_Write_Data2(uint8_t IIC_Addr, uint16_t DataLen,
|
||||
const uint8_t * DataPtr) {
|
||||
uint16_t Cnt;
|
||||
uint8_t tmp;
|
||||
|
||||
_i2cPort - > beginTransmission(IIC_Addr);
|
||||
_i2cPort - > write(0x0C);
|
||||
|
||||
for (Cnt = 0; Cnt < DataLen; Cnt++) {
|
||||
tmp = DataPtr[Cnt];
|
||||
_i2cPort - > write(tmp);
|
||||
}
|
||||
_i2cPort - > endTransmission();
|
||||
}
|
||||
|
||||
//---------------------------------CLEAR DISPLAY-----------------------------------//
|
||||
|
||||
void clearAll(void) {
|
||||
|
||||
for (uint16_t i; i < 230; i++) {
|
||||
AdjustIconLevel(i, 0x00);
|
||||
}
|
||||
|
||||
}
|
||||
@ -0,0 +1,220 @@
|
||||
/*
|
||||
This is an example of how to write a library that allows user to pass in an I2C port
|
||||
|
||||
Nathan Seidle
|
||||
SparkFun Electronics
|
||||
|
||||
License: Public domain
|
||||
*/
|
||||
|
||||
#include < Wire.h >
|
||||
|
||||
uint16_t DisplayLimit[6] = {199, 999, 999, 999, 99, 199};
|
||||
|
||||
bool begin(TwoWire & wirePort = Wire); //If user doesn't specify then Wire will be used
|
||||
|
||||
void AdjustIconLevel(uint16_t IconNo, uint16_t IconLevel);
|
||||
void D01(uint8_t Action);
|
||||
void CC1(uint8_t Action);
|
||||
void D02(uint8_t Action);
|
||||
void CC2(uint8_t Action);
|
||||
void D03(uint8_t Action);
|
||||
void CC3(uint8_t Action);
|
||||
void D04(uint8_t Action);
|
||||
void CC4(uint8_t Action);
|
||||
void D05(uint8_t Action);
|
||||
void CC5(uint8_t Action);
|
||||
void D06(uint8_t Action);
|
||||
void CC6(uint8_t Action);
|
||||
void D07(uint8_t Action);
|
||||
void CC7(uint8_t Action);
|
||||
void D08(uint8_t Action);
|
||||
void CC8(uint8_t Action);
|
||||
void D0x(uint8_t Action);
|
||||
void C01(uint8_t Action);
|
||||
void C02(uint8_t Action);
|
||||
void H01(uint8_t Action);
|
||||
void K01(uint8_t Action);
|
||||
void M01(uint8_t Action);
|
||||
void C03(uint8_t Action);
|
||||
void K02(uint8_t Action);
|
||||
void M03(uint8_t Action);
|
||||
void P01(uint8_t Action);
|
||||
void P02(uint8_t Action);
|
||||
void P03(uint8_t Action);
|
||||
void T01(uint8_t Action);
|
||||
void T02(uint8_t Action);
|
||||
|
||||
void compassCircle(uint8_t Select);
|
||||
void compassArrows(uint8_t Select);
|
||||
void radarDistanceUnits(uint8_t Action);
|
||||
void flag(uint8_t Action);
|
||||
void tirePressureAlert(uint8_t Action);
|
||||
void speedometerUnits(uint8_t Action);
|
||||
void destinationDistanceUnits(uint8_t iconUnits);
|
||||
void turnDistanceUnits(uint8_t iconUnits);
|
||||
|
||||
void leftTunnel(uint8_t Action);
|
||||
void middleTunnel(uint8_t Action);
|
||||
void rightTunnel(uint8_t Action);
|
||||
void leftRoad(uint8_t Action);
|
||||
void middleRoad(uint8_t Action);
|
||||
void rightRoad(uint8_t Action);
|
||||
|
||||
void nav_Group(uint8_t Action);
|
||||
void nav_KeepLeft(uint8_t Action);
|
||||
void nav_TurnLeft(uint8_t Action);
|
||||
void nav_TurnRight(uint8_t Action);
|
||||
void nav_HardRight(uint8_t Action);
|
||||
void nav_HardLeft(uint8_t Action);
|
||||
void nav_UTurnLeft(uint8_t Action);
|
||||
void nav_UTurnRight(uint8_t Action);
|
||||
void nav_ContinueStraight(uint8_t Action);
|
||||
void nav_KeepRight(uint8_t Action);
|
||||
|
||||
void setSegmentedDisplay(uint8_t Display, uint8_t SpeedNo, bool Mode);
|
||||
|
||||
#define setHeading(SpeedNo) setSegmentedDisplay(0, SpeedNo, false)
|
||||
#define setDestinationDistance(SpeedNo, Mode) setSegmentedDisplay(1, SpeedNo, Mode)
|
||||
#define setRadarDistance(SpeedNo, Mode) setSegmentedDisplay(2, SpeedNo, Mode)
|
||||
#define setTurnDistance(SpeedNo, Mode) setSegmentedDisplay(3, SpeedNo, Mode)
|
||||
#define setTirePressure(SpeedNo, Mode) setSegmentedDisplay(4, SpeedNo, Mode)
|
||||
#define setSpeedometer(SpeedNo) setSegmentedDisplay(5, SpeedNo, false)
|
||||
|
||||
void radarDetector(uint8_t Level);
|
||||
void setCallIcon(uint8_t iconStatus);
|
||||
|
||||
void clearAll(void);
|
||||
|
||||
void IIC_Write_Command1(uint8_t IIC_Addr, uint16_t DataLen, uint8_t * DataPtr);
|
||||
void IIC_Write_Data1(uint8_t IIC_Addr, uint16_t DataLen, uint8_t * DataPtr);
|
||||
void IIC_Write_Data2(uint8_t IIC_Addr, uint16_t DataLen,
|
||||
const uint8_t * DataPtr);
|
||||
|
||||
private:
|
||||
|
||||
uint16_t S1_2_3;
|
||||
uint16_t S4_5_6;
|
||||
uint16_t S7_8_9;
|
||||
uint16_t S10_11_12;
|
||||
uint16_t S13_14;
|
||||
uint16_t S15_16_17;
|
||||
|
||||
uint16_t ChangeRedValue(uint16_t OriginalValue, uint16_t R_Value);
|
||||
uint16_t ChangeGreenValue(uint16_t OriginalValue, uint16_t G_Value);
|
||||
uint16_t ChangeBlueValue(uint16_t OriginalValue, uint16_t B_Value);
|
||||
uint16_t ChangeRG_Value(uint16_t OriginalValue, uint16_t RG_Value);
|
||||
uint16_t ChangeGB_Value(uint16_t OriginalValue, uint16_t GB_Value);
|
||||
uint16_t SetRGB_Value(uint16_t RGB_Value);
|
||||
void NumericalTo4BCD(uint16_t S_Number, uint8_t * BCD_Ptr);
|
||||
|
||||
void DispNumber(const uint16_t * SegIconPtr, uint8_t DispNo);
|
||||
|
||||
void SoftReset(unsigned char DriverNo);
|
||||
void SetOscControl(unsigned char DriverNo, unsigned char mode);
|
||||
void SetGraphicsRAMWritingDirection(unsigned char DriverNo, unsigned char mode);
|
||||
void SetInterface(unsigned char DriverNo, unsigned char mode);
|
||||
void DisplayOnOff(unsigned char DriverNo, unsigned char Val);
|
||||
void DisplayStandbyOnOff(unsigned char DriverNo, unsigned char Val);
|
||||
void SetDisplaySize(unsigned char DriverNo, unsigned char Xstart, unsigned char Xend, unsigned char Ystart, unsigned char Yend);
|
||||
void SetDotCurrent(unsigned char DriverNo, unsigned char Rlevel, unsigned char Glevel, unsigned char Blevel);
|
||||
void SetSystemClockDivisionRatio(unsigned char DriverNo, unsigned char mode);
|
||||
void SetPreChargeWidth(unsigned char DriverNo, unsigned char Val);
|
||||
void SetPeakPulseWidth(unsigned char DriverNo, unsigned char Rlevel, unsigned char Glevel, unsigned char Blevel);
|
||||
void SetPeakPulseDelay(unsigned char DriverNo, unsigned char Val);
|
||||
void SetRowScanOperation(unsigned char DriverNo, unsigned char mode);
|
||||
void SetInternalRegulatorforRowScan(unsigned char DriverNo, unsigned char mode);
|
||||
void DumpDataToDriver(unsigned char DriverNo, unsigned int SData);
|
||||
|
||||
void initializeHUD231(void);
|
||||
|
||||
const uint8_t IIC_Addr[2] = { 0x30, 0x31 };
|
||||
|
||||
const uint8_t NumberSegTable[11] = { 0x3F, 0x06, 0x5B, 0x4F, 0x66, 0x6D, 0x7D, 0x07, 0x7F, 0x6F, 0x00 };
|
||||
|
||||
// T TR BR B BL TL M
|
||||
const uint8_t SegIconTable[6][3][7] = {{{ 0, 6, 7, 0, 0, 0, 0 },
|
||||
{ 10, 16, 14, 13, 12, 11, 15 },
|
||||
{ 19, 25, 23, 22, 21, 20, 24 }
|
||||
},
|
||||
{{ 33, 39, 37, 36, 35, 34, 38 },
|
||||
{ 41, 47, 45, 44, 43, 42, 46 },
|
||||
{ 49, 55, 53, 52, 51, 50, 54 }
|
||||
},
|
||||
{{ 59, 65, 63, 62, 61, 60, 64 },
|
||||
{ 66, 72, 70, 69, 68, 67, 71 },
|
||||
{ 73, 79, 77, 76, 75, 74, 78 }
|
||||
},
|
||||
{{ 131, 137, 135, 134, 133, 132, 136 },
|
||||
{ 138, 144, 142, 141, 140, 139, 143 },
|
||||
{ 146, 152, 150, 149, 148, 147, 151 }
|
||||
},
|
||||
{{ 0, 0, 0, 0, 0, 0, 0 },
|
||||
{ 182, 188, 186, 185, 184, 183, 187 },
|
||||
{ 190, 196, 194, 193, 192, 191, 195 }
|
||||
},
|
||||
{{ 0, 214, 215, 0, 0, 0, 0 },
|
||||
{ 216, 222, 220, 219, 218, 217, 221 },
|
||||
{ 223, 229, 227, 226, 225, 224, 228 }
|
||||
}};
|
||||
|
||||
typedef struct {
|
||||
uint8_t DriverNo;
|
||||
uint16_t StartBumpLocation;
|
||||
uint8_t BumpNo;
|
||||
uint8_t Level;
|
||||
} IconStruct;
|
||||
|
||||
const IconStruct IconData[231] = {
|
||||
{0, 0, 2, 30}, {0, 2, 2, 30}, {0, 4, 2, 30}, {0, 6, 2, 30}, {0, 8, 2, 30},
|
||||
{0, 10, 2, 30}, {0, 12, 1, 30}, {0, 13, 1, 30}, {0, 14, 2, 30}, {0, 16, 2, 30},
|
||||
{0, 18, 2, 30}, {0, 20, 1, 30}, {0, 21, 1, 30}, {0, 22, 2, 30}, {0, 24, 1, 30},
|
||||
{0, 25, 1, 30}, {0, 26, 1, 30}, {0, 27, 2, 30}, {0, 29, 2, 30}, {0, 31, 2, 30},
|
||||
{0, 33, 1, 30}, {0, 34, 1, 30}, {0, 35, 2, 30}, {0, 37, 1, 30}, {0, 38, 1, 30},
|
||||
{0, 39, 1, 30}, {0, 40, 2, 30}, {0, 42, 2, 30}, {0, 44, 2, 30}, {0, 46, 2, 30},
|
||||
{0, 48, 2, 30}, {0, 50, 2, 30}, {0, 52, 16, 30}, {0, 68, 3, 30}, {0, 71, 3, 30},
|
||||
{0, 74, 3, 30}, {0, 77, 3, 30}, {0, 80, 3, 30}, {0, 83, 3, 30}, {0, 86, 3, 30},
|
||||
{0, 89, 1, 30}, {0, 90, 3, 30}, {0, 93, 3, 30}, {0, 96, 3, 30}, {0, 99, 3, 30},
|
||||
{0, 102, 3, 30}, {0, 105, 3, 30}, {0, 108, 3, 30}, {0, 111, 1, 30}, {0, 112, 3, 30},
|
||||
{0, 115, 3, 30}, {0, 118, 3, 30}, {0, 121, 3, 30}, {0, 124, 3, 30}, {0, 127, 3, 30},
|
||||
{0, 130, 3, 30}, {0, 133, 4, 30}, {0, 137, 6, 30}, {0, 143, 5, 30}, {0, 148, 2, 30},
|
||||
{0, 150, 1, 30}, {0, 151, 1, 30}, {0, 152, 2, 30}, {0, 154, 1, 30}, {0, 155, 1, 30},
|
||||
{0, 156, 1, 30}, {0, 157, 2, 30}, {0, 159, 1, 30}, {0, 160, 1, 30}, {0, 161, 2, 30},
|
||||
{0, 163, 1, 30}, {0, 164, 1, 30}, {0, 165, 1, 30}, {0, 166, 2, 30}, {0, 168, 1, 30},
|
||||
{0, 169, 1, 30}, {0, 170, 2, 30}, {0, 172, 1, 30}, {0, 173, 1, 30}, {0, 174, 1, 30},
|
||||
{0, 175, 3, 30}, {0, 178, 7, 30}, {0, 185, 1, 3}, {0, 186, 1, 3}, {0, 187, 1, 3},
|
||||
{0, 188, 1, 3}, {0, 189, 1, 3}, {0, 190, 1, 3}, {0, 191, 1, 3}, {0, 192, 1, 30},
|
||||
{0, 193, 2, 30}, {0, 195, 2, 30}, {0, 197, 1, 30}, {0, 198, 1, 30}, {0, 199, 2, 30},
|
||||
{0, 201, 1, 30}, {0, 202, 1, 30}, {0, 203, 3, 30}, {0, 206, 1, 30}, {0, 207, 1, 30},
|
||||
{0, 208, 1, 30}, {0, 209, 1, 30}, {0, 210, 3, 30}, {0, 213, 5, 30}, {0, 218, 4, 30},
|
||||
{0, 222, 1, 5}, {0, 223, 1, 12}, {0, 224, 6, 30}, {0, 230, 2, 30}, {0, 232, 5, 30},
|
||||
{0, 237, 4, 30}, {0, 241, 1, 5}, {0, 242, 1, 12}, {0, 243, 5, 30}, {0, 248, 2, 30},
|
||||
{0, 250, 5, 30}, {0, 255, 3, 30}, {0, 258, 2, 30}, {0, 260, 3, 30}, {0, 263, 1, 15},
|
||||
{0, 264, 1, 30}, {0, 265, 1, 15}, {0, 266, 1, 10}, {0, 267, 4, 30}, {0, 271, 1, 30},
|
||||
{0, 272, 2, 30}, {0, 274, 5, 30}, {0, 279, 4, 30}, {0, 283, 1, 5}, {0, 284, 7, 20},
|
||||
{0, 291, 4, 31}, {0, 295, 1, 15}, {0, 296, 1, 15}, {0, 297, 1, 15}, {0, 298, 1, 15},
|
||||
{0, 299, 1, 15}, {0, 300, 1, 15}, {0, 301, 1, 15}, {0, 302, 1, 15}, {0, 303, 1, 15},
|
||||
{0, 304, 1, 15}, {0, 305, 1, 15}, {0, 306, 1, 15}, {0, 307, 1, 15}, {0, 308, 1, 15},
|
||||
{0, 309, 1, 5}, {0, 310, 1, 15}, {0, 311, 1, 15}, {0, 312, 1, 15}, {0, 313, 1, 15},
|
||||
{0, 314, 1, 15}, {0, 315, 1, 15}, {0, 316, 1, 15}, {0, 317, 2, 15}, {0, 319, 2, 15},
|
||||
{0, 321, 7, 20}, {0, 328, 1, 5}, {0, 329, 4, 30}, {0, 333, 5, 30}, {0, 338, 2, 30},
|
||||
{0, 340, 1, 30}, {0, 341, 4, 30}, {0, 345, 1, 10}, {0, 346, 1, 12}, {0, 347, 1, 30},
|
||||
{0, 348, 1, 15}, {0, 349, 3, 30}, {0, 352, 2, 30}, {0, 354, 3, 30}, {0, 357, 5, 30},
|
||||
{0, 362, 2, 30}, {0, 364, 5, 30}, {0, 369, 1, 12}, {0, 370, 1, 5}, {0, 371, 4, 30},
|
||||
{0, 375, 5, 30}, {0, 380, 2, 30}, {1, 0, 6, 30}, {1, 6, 1, 12}, {1, 7, 4, 30},
|
||||
{1, 11, 2, 30}, {1, 13, 5, 30}, {1, 18, 1, 15}, {1, 19, 1, 15}, {1, 20, 1, 15},
|
||||
{1, 21, 1, 15}, {1, 22, 1, 15}, {1, 23, 1, 15}, {1, 24, 1, 15}, {1, 25, 2, 30},
|
||||
{1, 27, 1, 15}, {1, 28, 1, 15}, {1, 29, 1, 15}, {1, 30, 1, 15}, {1, 31, 1, 15},
|
||||
{1, 32, 1, 15}, {1, 33, 1, 15}, {1, 34, 28, 30}, {1, 62, 1, 30}, {1, 63, 1, 30},
|
||||
{1, 64, 1, 30}, {1, 65, 1, 30}, {1, 66, 3, 30}, {1, 69, 1, 30}, {1, 70, 1, 30},
|
||||
{1, 71, 2, 30}, {1, 73, 1, 30}, {1, 74, 1, 30}, {1, 75, 2, 30}, {1, 77, 2, 30},
|
||||
{1, 79, 1, 30}, {1, 80, 6, 30}, {1, 86, 5, 30}, {1, 91, 2, 30}, {1, 93, 17, 30},
|
||||
{1, 110, 16, 30}, {1, 126, 18, 30}, {1, 144, 14, 30}, {1, 158, 14, 30}, {1, 172, 17, 30},
|
||||
{1, 189, 17, 30}, {1, 206, 16, 30}, {1, 222, 16, 30}, {1, 238, 18, 30}, {1, 256, 14, 30},
|
||||
{1, 270, 14, 30}, {1, 284, 17, 30}, {1, 301, 17, 30}, {1, 318, 16, 30}, {1, 334, 16, 30},
|
||||
{1, 350, 33, 30}
|
||||
};
|
||||
|
||||
uint16_t IconRamMap[2][128];
|
||||
uint8_t SendDataBuffer[1024]; //1024
|
||||
uint8_t ReceiveData[1024]; //1024
|
||||
@ -0,0 +1,125 @@
|
||||
/* Copyright 2018 Jack Humbert <jack.humb@gmail.com>
|
||||
*
|
||||
* 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 2 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/>.
|
||||
*/
|
||||
#include "joystiic.h"
|
||||
#include "print.h"
|
||||
#include "action.h"
|
||||
|
||||
#define JOYSTIIC_DEFAULT_ADDR 0x20
|
||||
#define JOYSTIIC_COMMAND_HORIZONTAL 0x00
|
||||
#define JOYSTIIC_COMMAND_VERTICAL 0x02
|
||||
#define JOYSTIIC_COMMAND_BUTTON 0x04
|
||||
|
||||
#define JOYSTIIC_CENTER 512
|
||||
#define JOYSTIIC_DEADZONE 200
|
||||
|
||||
uint16_t joystiic_horizontal;
|
||||
uint16_t joystiic_vertical;
|
||||
bool joystiic_button;
|
||||
|
||||
uint8_t joystiic_tx[1];
|
||||
uint8_t joystiic_rx_horizontal[2];
|
||||
uint8_t joystiic_rx_vertical[2];
|
||||
uint8_t joystiic_rx_button[1];
|
||||
|
||||
bool joystiic_triggered[5] = {0};
|
||||
|
||||
void joystiic_init(void) {
|
||||
i2c_init();
|
||||
i2c_start(JOYSTIIC_DEFAULT_ADDR);
|
||||
}
|
||||
|
||||
void joystiic_update(uint16_t horizontal, uint16_t vertical, bool button) {
|
||||
joystiic_update_kb(horizontal, vertical, button);
|
||||
joystiic_update_user(horizontal, vertical, button);
|
||||
}
|
||||
|
||||
__attribute__ ((weak))
|
||||
void joystiic_update_kb(uint16_t horizontal, uint16_t vertical, bool button) { }
|
||||
|
||||
__attribute__ ((weak))
|
||||
void joystiic_update_user(uint16_t horizontal, uint16_t vertical, bool button) { }
|
||||
|
||||
void joystiic_trigger(uint8_t trigger, bool active) {
|
||||
joystiic_trigger_kb(trigger, active);
|
||||
joystiic_trigger_user(trigger, active);
|
||||
}
|
||||
|
||||
__attribute__ ((weak))
|
||||
void joystiic_trigger_kb(uint8_t trigger, bool active) { }
|
||||
|
||||
__attribute__ ((weak))
|
||||
void joystiic_trigger_user(uint8_t trigger, bool active) { }
|
||||
|
||||
void joystiic_trigger_if_not(uint8_t trigger, bool active) {
|
||||
if (joystiic_triggered[trigger] != active) {
|
||||
joystiic_triggered[trigger] = active;
|
||||
joystiic_trigger(trigger, active);
|
||||
}
|
||||
}
|
||||
|
||||
void joystiic_task(void) {
|
||||
// get horizontal axis
|
||||
joystiic_tx[0] = JOYSTIIC_COMMAND_HORIZONTAL;
|
||||
|
||||
if (MSG_OK != i2c_transmit_receive(JOYSTIIC_DEFAULT_ADDR << 1,
|
||||
joystiic_tx, 1,
|
||||
joystiic_rx_horizontal, 2
|
||||
)) {
|
||||
printf("error hori\n");
|
||||
}
|
||||
|
||||
joystiic_horizontal = ((uint16_t)joystiic_rx_horizontal[0] << 8) | joystiic_rx_horizontal[1];
|
||||
|
||||
joystiic_trigger_if_not(JOYSTIIC_LEFT, joystiic_horizontal > (JOYSTIIC_CENTER + JOYSTIIC_DEADZONE));
|
||||
joystiic_trigger_if_not(JOYSTIIC_RIGHT, joystiic_horizontal < (JOYSTIIC_CENTER - JOYSTIIC_DEADZONE));
|
||||
|
||||
// get vertical axis
|
||||
joystiic_tx[0] = JOYSTIIC_COMMAND_VERTICAL;
|
||||
if (MSG_OK != i2c_transmit_receive(JOYSTIIC_DEFAULT_ADDR << 1,
|
||||
joystiic_tx, 1,
|
||||
joystiic_rx_vertical, 2
|
||||
)) {
|
||||
printf("error vert\n");
|
||||
}
|
||||
|
||||
joystiic_vertical = ((uint16_t)joystiic_rx_vertical[0] << 8) | joystiic_rx_vertical[1];
|
||||
|
||||
joystiic_trigger_if_not(JOYSTIIC_UP, joystiic_vertical > (JOYSTIIC_CENTER + JOYSTIIC_DEADZONE));
|
||||
joystiic_trigger_if_not(JOYSTIIC_DOWN, joystiic_vertical < (JOYSTIIC_CENTER - JOYSTIIC_DEADZONE));
|
||||
|
||||
// get button press
|
||||
joystiic_tx[0] = JOYSTIIC_COMMAND_BUTTON;
|
||||
if (MSG_OK != i2c_transmit_receive(JOYSTIIC_DEFAULT_ADDR << 1,
|
||||
joystiic_tx, 1,
|
||||
joystiic_rx_button, 1
|
||||
)) {
|
||||
printf("error vert\n");
|
||||
}
|
||||
|
||||
joystiic_button = !joystiic_rx_button[0];
|
||||
|
||||
joystiic_trigger_if_not(JOYSTIIC_PRESS, joystiic_button);
|
||||
|
||||
joystiic_update(joystiic_horizontal, joystiic_vertical, joystiic_button);
|
||||
|
||||
//printf("%d\n", joystiic[0]);
|
||||
|
||||
// SEND_STRING("H: ");
|
||||
// send_word(joystiic_rx_horizontal[0]);
|
||||
// tap_code(KC_SPACE);
|
||||
// send_word(joystiic_rx_horizontal[1]);
|
||||
// tap_code(KC_SPACE);
|
||||
}
|
||||
@ -0,0 +1,34 @@
|
||||
/* Copyright 2018 Jack Humbert <jack.humb@gmail.com>
|
||||
*
|
||||
* 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 2 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/>.
|
||||
*/
|
||||
#pragma once
|
||||
|
||||
#include "qwiic.h"
|
||||
|
||||
enum {
|
||||
JOYSTIIC_LEFT,
|
||||
JOYSTIIC_RIGHT,
|
||||
JOYSTIIC_UP,
|
||||
JOYSTIIC_DOWN,
|
||||
JOYSTIIC_PRESS
|
||||
};
|
||||
|
||||
void joystiic_update_kb(uint16_t horizontal, uint16_t vertical, bool button);
|
||||
void joystiic_update_user(uint16_t horizontal, uint16_t vertical, bool button);
|
||||
void joystiic_trigger_kb(uint8_t trigger, bool active);
|
||||
void joystiic_trigger_user(uint8_t trigger, bool active);
|
||||
|
||||
void joystiic_init(void);
|
||||
void joystiic_task(void);
|
||||
@ -0,0 +1,28 @@
|
||||
/* Copyright 2018 Jack Humbert <jack.humb@gmail.com>
|
||||
*
|
||||
* 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 2 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/>.
|
||||
*/
|
||||
#include "qwiic.h"
|
||||
|
||||
void qwiic_init(void) {
|
||||
#ifdef QWIIC_JOYSTIIC_ENABLE
|
||||
joystiic_init();
|
||||
#endif
|
||||
}
|
||||
|
||||
void qwiic_task(void) {
|
||||
#ifdef QWIIC_JOYSTIIC_ENABLE
|
||||
joystiic_task();
|
||||
#endif
|
||||
}
|
||||
@ -0,0 +1,25 @@
|
||||
/* Copyright 2018 Jack Humbert <jack.humb@gmail.com>
|
||||
*
|
||||
* 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 2 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/>.
|
||||
*/
|
||||
#pragma once
|
||||
|
||||
#include "i2c_master.h"
|
||||
|
||||
#ifdef QWIIC_JOYSTIIC_ENABLE
|
||||
#include "joystiic.h"
|
||||
#endif
|
||||
|
||||
void qwiic_init(void);
|
||||
void qwiic_task(void);
|
||||
@ -0,0 +1,13 @@
|
||||
ifneq ($(strip $(QWIIC_ENABLE)),)
|
||||
COMMON_VPATH += $(DRIVER_PATH)/qwiic
|
||||
OPT_DEFS += -DQWIIC_ENABLE
|
||||
SRC += qwiic.c
|
||||
ifeq ($(filter "i2c_master.c", $(SRC)),)
|
||||
SRC += i2c_master.c
|
||||
endif
|
||||
endif
|
||||
|
||||
ifneq ($(filter JOYSTIIC, $(QWIIC_ENABLE)),)
|
||||
OPT_DEFS += -DQWIIC_JOYSTIIC_ENABLE
|
||||
SRC += joystiic.c
|
||||
endif
|
||||
@ -0,0 +1,7 @@
|
||||
# Qwiic Devices
|
||||
|
||||
[More info on Sparkfun's Qwiic Connect System](https://www.sparkfun.com/qwiic)
|
||||
|
||||
Currently supported devices:
|
||||
|
||||
* [Joystiic](https://www.sparkfun.com/products/14656)
|
||||
Loading…
Reference in new issue