mirrors/uv-k5-firmware-custom
0
Fork 0
mirror of https://github.com/OneOfEleven/uv-k5-firmware-custom.git synced 2025-06-18 14:19:49 +03:00
Code Issues Releases Activity

Simplified user TX power menu

Browse Source
This commit is contained in:
OneOfEleven
2023-11-24 17:51:59 +00:00
parent f24b6b41bf
commit ecfc99c81c
7 changed files with 85 additions and 112 deletions
Download Patch File Download Diff File Expand all files Collapse all files

96
driver/i2c.c
View File

@ -44,9 +44,11 @@ void I2C_Stop(void)
SYSTICK_Delay250ns(4);
}
uint8_t I2C_Read_fast(bool bFinal)
uint8_t I2C_Read(const bool end, const bool fast)
{
uint8_t i, Data;
const unsigned int delay = fast ? 2 : 4;
unsigned int i;
uint8_t Data;
PORTCON_PORTA_IE |= PORTCON_PORTA_IE_A11_BITS_ENABLE;
PORTCON_PORTA_OD &= ~PORTCON_PORTA_OD_A11_MASK;
@ -56,72 +58,31 @@ uint8_t I2C_Read_fast(bool bFinal)
for (i = 0; i < 8; i++)
{
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(2);
SYSTICK_Delay250ns(delay);
GPIO_SetBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(2);
SYSTICK_Delay250ns(delay);
Data <<= 1;
SYSTICK_Delay250ns(2);
SYSTICK_Delay250ns(delay);
if (GPIO_CheckBit(&GPIOA->DATA, GPIOA_PIN_I2C_SDA))
Data |= 1U;
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(2);
SYSTICK_Delay250ns(delay);
}
PORTCON_PORTA_IE &= ~PORTCON_PORTA_IE_A11_MASK;
PORTCON_PORTA_OD |= PORTCON_PORTA_OD_A11_BITS_ENABLE;
GPIOA->DIR |= GPIO_DIR_11_BITS_OUTPUT;
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(2);
if (bFinal)
SYSTICK_Delay250ns(delay);
if (end)
GPIO_SetBit(&GPIOA->DATA, GPIOA_PIN_I2C_SDA);
else
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SDA);
SYSTICK_Delay250ns(2);
SYSTICK_Delay250ns(delay);
GPIO_SetBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(2);
SYSTICK_Delay250ns(delay);
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(2);
return Data;
}
uint8_t I2C_Read(bool bFinal)
{
uint8_t i, Data;
PORTCON_PORTA_IE |= PORTCON_PORTA_IE_A11_BITS_ENABLE;
PORTCON_PORTA_OD &= ~PORTCON_PORTA_OD_A11_MASK;
GPIOA->DIR &= ~GPIO_DIR_11_MASK;
Data = 0;
for (i = 0; i < 8; i++)
{
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(4);
GPIO_SetBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(4);
Data <<= 1;
SYSTICK_Delay250ns(4);
if (GPIO_CheckBit(&GPIOA->DATA, GPIOA_PIN_I2C_SDA))
Data |= 1U;
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(4);
}
PORTCON_PORTA_IE &= ~PORTCON_PORTA_IE_A11_MASK;
PORTCON_PORTA_OD |= PORTCON_PORTA_OD_A11_BITS_ENABLE;
GPIOA->DIR |= GPIO_DIR_11_BITS_OUTPUT;
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(4);
if (bFinal)
GPIO_SetBit(&GPIOA->DATA, GPIOA_PIN_I2C_SDA);
else
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SDA);
SYSTICK_Delay250ns(4);
GPIO_SetBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(4);
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(4);
SYSTICK_Delay250ns(delay);
return Data;
}
@ -133,12 +94,12 @@ int I2C_Write(uint8_t Data)
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(4);
for (i = 0; i < 8; i++) {
if ((Data & 0x80) == 0) {
for (i = 0; i < 8; i++)
{
if ((Data & 0x80) == 0)
GPIO_ClearBit(&GPIOA->DATA, GPIOA_PIN_I2C_SDA);
} else {
else
GPIO_SetBit(&GPIOA->DATA, GPIOA_PIN_I2C_SDA);
}
Data <<= 1;
SYSTICK_Delay250ns(4);
GPIO_SetBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
@ -155,8 +116,10 @@ int I2C_Write(uint8_t Data)
GPIO_SetBit(&GPIOA->DATA, GPIOA_PIN_I2C_SCL);
SYSTICK_Delay250ns(4);
for (i = 0; i < 255; i++) {
if (GPIO_CheckBit(&GPIOA->DATA, GPIOA_PIN_I2C_SDA) == 0) {
for (i = 0; i < 255; i++)
{
if (GPIO_CheckBit(&GPIOA->DATA, GPIOA_PIN_I2C_SDA) == 0)
{
ret = 0;
break;
}
@ -179,22 +142,13 @@ int I2C_ReadBuffer(void *pBuffer, const unsigned int Size, const bool fast)
if (Size == 1)
{
*pData = fast ? I2C_Read_fast(true) : I2C_Read(true);
*pData = I2C_Read(true, fast);
return 1;
}
if (fast)
{
for (i = 0; i < (Size - 1); i++)
pData[i] = I2C_Read_fast(false);
pData[i++] = I2C_Read_fast(true);
}
else
{
for (i = 0; i < (Size - 1); i++)
pData[i] = I2C_Read(false);
pData[i++] = I2C_Read(true);
}
for (i = 0; i < (Size - 1); i++)
pData[i] = I2C_Read(false, fast);
pData[i++] = I2C_Read(true, fast);
return Size;
}

3
driver/i2c.h
View File

@ -28,8 +28,7 @@ enum {
void I2C_Start(void);
void I2C_Stop(void);
uint8_t I2C_Read(bool bFinal);
uint8_t I2C_Read_fast(bool bFinal);
uint8_t I2C_Read(const bool end, const bool fast);
int I2C_Write(uint8_t Data);
int I2C_ReadBuffer(void *pBuffer, unsigned int Size, const bool fast);