github/RRG-Proxmark3
1
0
Fork 0
mirror of https://github.com/RfidResearchGroup/proxmark3.git synced 2025-08-20 05:13:46 -07:00
Code Issues Projects Releases Packages Wiki Activity Actions 4

style

Browse source
This commit is contained in:
iceman1001 2023-09-17 17:41:58 +02:00
commit 78adf186d3
1 changed files with 122 additions and 71 deletions
Download patch file Download diff file Expand all files Collapse all files

193
armsrc/i2c.c
View file

@ -181,7 +181,7 @@ static bool WaitSCL_H(void) {
static bool WaitSCL_L_delay(uint32_t delay) { static bool WaitSCL_L_delay(uint32_t delay) {
while (delay--) { while (delay--) {
if (!SCL_read) { if (SCL_read == false) {
return true; return true;
} }
I2C_DELAY_1CLK; I2C_DELAY_1CLK;
@ -217,15 +217,19 @@ static bool I2C_Start(void) {
SDA_H; SDA_H;
I2C_DELAY_1CLK; I2C_DELAY_1CLK;
SCL_H; SCL_H;
if (!WaitSCL_H()) if (WaitSCL_H() == false) {
return false; return false;
}
I2C_DELAY_2CLK; I2C_DELAY_2CLK;
if (!SCL_read) if (SCL_read == false) {
return false; return false;
if (!SDA_read) }
if (SDA_read == false) {
return false; return false;
}
SDA_L; SDA_L;
I2C_DELAY_2CLK; I2C_DELAY_2CLK;
@ -298,8 +302,9 @@ static bool I2C_WaitAck(void) {
SDA_H; SDA_H;
I2C_DELAY_1CLK; I2C_DELAY_1CLK;
SCL_H; SCL_H;
if (!WaitSCL_H()) if (WaitSCL_H() == false) {
return false; return false;
}
I2C_DELAY_2CLK; I2C_DELAY_2CLK;
I2C_DELAY_2CLK; I2C_DELAY_2CLK;
@ -312,6 +317,7 @@ static bool I2C_WaitAck(void) {
} }
static void I2C_SendByte(uint8_t data) { static void I2C_SendByte(uint8_t data) {
uint8_t bits = 8; uint8_t bits = 8;
while (bits--) { while (bits--) {
@ -329,8 +335,9 @@ static void I2C_SendByte(uint8_t data) {
I2C_DELAY_1CLK; I2C_DELAY_1CLK;
SCL_H; SCL_H;
if (!WaitSCL_H()) if (WaitSCL_H() == false) {
return; return;
}
I2C_DELAY_2CLK; I2C_DELAY_2CLK;
} }
@ -342,94 +349,112 @@ static int16_t I2C_ReadByte(void) {
SDA_H; SDA_H;
while (bits--) { while (bits--) {
b <<= 1; b <<= 1;
SCL_L; SCL_L;
if (!WaitSCL_L()) return -2; if (WaitSCL_L() == false) {
return -2;
}
I2C_DELAY_1CLK; I2C_DELAY_1CLK;
SCL_H; SCL_H;
if (!WaitSCL_H()) return -1; if (WaitSCL_H() == false) {
return -1;
}
I2C_DELAY_1CLK; I2C_DELAY_1CLK;
if (SDA_read) if (SDA_read) {
b |= 0x01; b |= 0x01;
}
} }
SCL_L; SCL_L;
return b; return b;
} }
// Sends one byte ( command to be written, SlaveDevice address) // Sends one byte (command to be written, SlaveDevice address)
bool I2C_WriteCmd(uint8_t device_cmd, uint8_t device_address) { bool I2C_WriteCmd(uint8_t device_cmd, uint8_t device_address) {
bool bBreak = true; bool _break = true;
do { do {
if (!I2C_Start()) if (I2C_Start() == false) {
return false; return false;
}
I2C_SendByte(device_address & 0xFE); I2C_SendByte(device_address & 0xFE);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
I2C_SendByte(device_cmd); I2C_SendByte(device_cmd);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
bBreak = false; _break = false;
} while (false); } while (false);
I2C_Stop(); I2C_Stop();
if (bBreak) {
if (_break) {
if (g_dbglevel > 3) DbpString(I2C_ERROR); if (g_dbglevel > 3) DbpString(I2C_ERROR);
return false; return false;
} }
return true; return true;
} }
// Sends 1 byte data (Data to be written, command to be written , SlaveDevice address ). // Sends 1 byte data (data to be written, command to be written , SlaveDevice address)
bool I2C_WriteByte(uint8_t data, uint8_t device_cmd, uint8_t device_address) { bool I2C_WriteByte(uint8_t data, uint8_t device_cmd, uint8_t device_address) {
bool bBreak = true; bool _break = true;
do { do {
if (!I2C_Start()) if (I2C_Start() == false) {
return false; return false;
}
I2C_SendByte(device_address & 0xFE); I2C_SendByte(device_address & 0xFE);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
I2C_SendByte(device_cmd); I2C_SendByte(device_cmd);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
I2C_SendByte(data); I2C_SendByte(data);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
bBreak = false; _break = false;
} while (false); } while (false);
I2C_Stop(); I2C_Stop();
if (bBreak) { if (_break) {
if (g_dbglevel > 3) DbpString(I2C_ERROR); if (g_dbglevel > 3) DbpString(I2C_ERROR);
return false; return false;
} }
return true; return true;
} }
//Sends array of data (Array, length, command to be written , SlaveDevice address ). // Sends array of data (array, length, command to be written , SlaveDevice address)
// len = uint16 because we need to write up to 256 bytes // len = uint16 because we need to write up to 256 bytes
bool I2C_BufferWrite(const uint8_t *data, uint16_t len, uint8_t device_cmd, uint8_t device_address) { bool I2C_BufferWrite(const uint8_t *data, uint16_t len, uint8_t device_cmd, uint8_t device_address) {
bool bBreak = true; bool _break = true;
do { do {
if (!I2C_Start()) if (I2C_Start() == false) {
return false; return false;
}
I2C_SendByte(device_address & 0xFE); I2C_SendByte(device_address & 0xFE);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
I2C_SendByte(device_cmd); I2C_SendByte(device_cmd);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
while (len) { while (len) {
@ -441,12 +466,14 @@ bool I2C_BufferWrite(const uint8_t *data, uint16_t len, uint8_t device_cmd, uint
data++; data++;
} }
if (len == 0) if (len == 0) {
bBreak = false; _break = false;
}
} while (false); } while (false);
I2C_Stop(); I2C_Stop();
if (bBreak) { if (_break) {
if (g_dbglevel > 3) DbpString(I2C_ERROR); if (g_dbglevel > 3) DbpString(I2C_ERROR);
return false; return false;
} }
@ -457,40 +484,47 @@ bool I2C_BufferWrite(const uint8_t *data, uint16_t len, uint8_t device_cmd, uint
// len = uint16 because we need to read up to 256bytes // len = uint16 because we need to read up to 256bytes
int16_t I2C_BufferRead(uint8_t *data, uint16_t len, uint8_t device_cmd, uint8_t device_address) { int16_t I2C_BufferRead(uint8_t *data, uint16_t len, uint8_t device_cmd, uint8_t device_address) {
if (!data || len == 0) // sanity check
if (data == NULL || len == 0) {
return 0; return 0;
}
// extra wait 500us (514us measured) // extra wait 500us (514us measured)
// 200us (xx measured) // 200us (xx measured)
WaitUS(600); WaitUS(600);
bool bBreak = true; bool _break = true;
uint16_t readcount = 0; uint16_t readcount = 0;
uint16_t recv_len = 0; uint16_t recv_len = 0;
do { do {
if (!I2C_Start()) if (I2C_Start() == false) {
return 0; return 0;
}
// 0xB0 / 0xC0 == i2c write // 0xB0 / 0xC0 == i2c write
I2C_SendByte(device_address & 0xFE); I2C_SendByte(device_address & 0xFE);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
I2C_SendByte(device_cmd); I2C_SendByte(device_cmd);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
// 0xB1 / 0xC1 == i2c read // 0xB1 / 0xC1 == i2c read
I2C_Start(); I2C_Start();
I2C_SendByte(device_address | 1); I2C_SendByte(device_address | 1);
if (!I2C_WaitAck())
break;
bBreak = false; if (I2C_WaitAck() == false) {
break;
}
_break = false;
} while (false); } while (false);
if (bBreak) { if (_break) {
I2C_Stop(); I2C_Stop();
if (g_dbglevel > 3) DbpString(I2C_ERROR); if (g_dbglevel > 3) DbpString(I2C_ERROR);
return 0; return 0;
@ -499,8 +533,9 @@ int16_t I2C_BufferRead(uint8_t *data, uint16_t len, uint8_t device_cmd, uint8_t
while (len) { while (len) {
int16_t tmp = I2C_ReadByte(); int16_t tmp = I2C_ReadByte();
if (tmp < 0) if (tmp < 0) {
return tmp; return tmp;
}
*data = (uint8_t)tmp & 0xFF; *data = (uint8_t)tmp & 0xFF;
@ -547,12 +582,16 @@ int16_t I2C_BufferRead(uint8_t *data, uint16_t len, uint8_t device_cmd, uint8_t
I2C_Stop(); I2C_Stop();
// return bytecount - bytes encoding length // return bytecount - bytes encoding length
return readcount - (device_cmd == I2C_DEVICE_CMD_READ ? 2 : 1); if (device_cmd == I2C_DEVICE_CMD_READ) {
return readcount - 2;
}
return readcount - 1;
} }
int16_t I2C_ReadFW(uint8_t *data, uint8_t len, uint8_t msb, uint8_t lsb, uint8_t device_address) { int16_t I2C_ReadFW(uint8_t *data, uint8_t len, uint8_t msb, uint8_t lsb, uint8_t device_address) {
//START, 0xB0, 0x00, 0x00, START, 0xB1, xx, yy, zz, ......, STOP //START, 0xB0, 0x00, 0x00, START, 0xB1, xx, yy, zz, ......, STOP
bool bBreak = true; bool _break = true;
uint8_t readcount = 0; uint8_t readcount = 0;
// sending // sending
@ -579,10 +618,10 @@ int16_t I2C_ReadFW(uint8_t *data, uint8_t len, uint8_t msb, uint8_t lsb, uint8_t
if (!I2C_WaitAck()) if (!I2C_WaitAck())
break; break;
bBreak = false; _break = false;
} while (false); } while (false);
if (bBreak) { if (_break) {
I2C_Stop(); I2C_Stop();
if (g_dbglevel > 3) DbpString(I2C_ERROR); if (g_dbglevel > 3) DbpString(I2C_ERROR);
return 0; return 0;
@ -592,8 +631,9 @@ int16_t I2C_ReadFW(uint8_t *data, uint8_t len, uint8_t msb, uint8_t lsb, uint8_t
while (len) { while (len) {
int16_t tmp = I2C_ReadByte(); int16_t tmp = I2C_ReadByte();
if (tmp < 0) if (tmp < 0) {
return tmp; return tmp;
}
*data = (uint8_t)tmp & 0xFF; *data = (uint8_t)tmp & 0xFF;
@ -614,40 +654,47 @@ int16_t I2C_ReadFW(uint8_t *data, uint8_t len, uint8_t msb, uint8_t lsb, uint8_t
bool I2C_WriteFW(const uint8_t *data, uint8_t len, uint8_t msb, uint8_t lsb, uint8_t device_address) { bool I2C_WriteFW(const uint8_t *data, uint8_t len, uint8_t msb, uint8_t lsb, uint8_t device_address) {
//START, 0xB0, 0x00, 0x00, xx, yy, zz, ......, STOP //START, 0xB0, 0x00, 0x00, xx, yy, zz, ......, STOP
bool bBreak = true; bool _break = true;
do { do {
if (!I2C_Start()) if (I2C_Start() == false) {
return false; return false;
}
// 0xB0 == i2c write // 0xB0 == i2c write
I2C_SendByte(device_address & 0xFE); I2C_SendByte(device_address & 0xFE);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
I2C_SendByte(msb); I2C_SendByte(msb);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
I2C_SendByte(lsb); I2C_SendByte(lsb);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
while (len) { while (len) {
I2C_SendByte(*data); I2C_SendByte(*data);
if (!I2C_WaitAck()) if (I2C_WaitAck() == false) {
break; break;
}
len--; len--;
data++; data++;
} }
if (len == 0) if (len == 0) {
bBreak = false; _break = false;
}
} while (false); } while (false);
I2C_Stop(); I2C_Stop();
if (bBreak) {
if (_break) {
if (g_dbglevel > 3) DbpString(I2C_ERROR); if (g_dbglevel > 3) DbpString(I2C_ERROR);
return false; return false;
} }
@ -656,10 +703,11 @@ bool I2C_WriteFW(const uint8_t *data, uint8_t len, uint8_t msb, uint8_t lsb, uin
void I2C_print_status(void) { void I2C_print_status(void) {
DbpString(_CYAN_("Smart card module (ISO 7816)")); DbpString(_CYAN_("Smart card module (ISO 7816)"));
uint8_t maj, min;
if (I2C_get_version(&maj, &min) == PM3_SUCCESS) { uint8_t major, minor;
Dbprintf(" version................. " _YELLOW_("v%x.%02d"), maj, min); if (I2C_get_version(&major, &minor) == PM3_SUCCESS) {
if (maj < 4) { Dbprintf(" version................. " _YELLOW_("v%x.%02d"), major, minor);
if (major < 4) {
DbpString(" " _RED_("Outdated firmware.") " Please upgrade to v4.x or above."); DbpString(" " _RED_("Outdated firmware.") " Please upgrade to v4.x or above.");
} }
} else { } else {
@ -667,13 +715,13 @@ void I2C_print_status(void) {
} }
} }
int I2C_get_version(uint8_t *maj, uint8_t *min) { int I2C_get_version(uint8_t *major, uint8_t *minor) {
uint8_t resp[] = {0, 0, 0, 0}; uint8_t resp[] = {0, 0, 0, 0};
I2C_Reset_EnterMainProgram(); I2C_Reset_EnterMainProgram();
uint8_t len = I2C_BufferRead(resp, sizeof(resp), I2C_DEVICE_CMD_GETVERSION, I2C_DEVICE_ADDRESS_MAIN); uint8_t len = I2C_BufferRead(resp, sizeof(resp), I2C_DEVICE_CMD_GETVERSION, I2C_DEVICE_ADDRESS_MAIN);
if (len > 0) { if (len > 0) {
*maj = resp[0]; *major = resp[0];
*min = resp[1]; *minor = resp[1];
return PM3_SUCCESS; return PM3_SUCCESS;
} }
return PM3_EDEVNOTSUPP; return PM3_EDEVNOTSUPP;
@ -682,7 +730,7 @@ int I2C_get_version(uint8_t *maj, uint8_t *min) {
// Will read response from smart card module, retries 3 times to get the data. // Will read response from smart card module, retries 3 times to get the data.
bool sc_rx_bytes(uint8_t *dest, uint16_t *destlen, uint32_t wait) { bool sc_rx_bytes(uint8_t *dest, uint16_t *destlen, uint32_t wait) {
uint8_t i = 5; uint8_t i = 10;
int16_t len = 0; int16_t len = 0;
while (i--) { while (i--) {
@ -701,9 +749,9 @@ bool sc_rx_bytes(uint8_t *dest, uint16_t *destlen, uint32_t wait) {
} }
} }
// after three if (len < 1) {
if (len <= 1)
return false; return false;
}
*destlen = len; *destlen = len;
return true; return true;
@ -711,8 +759,9 @@ bool sc_rx_bytes(uint8_t *dest, uint16_t *destlen, uint32_t wait) {
bool GetATR(smart_card_atr_t *card_ptr, bool verbose) { bool GetATR(smart_card_atr_t *card_ptr, bool verbose) {
if (card_ptr == NULL) if (card_ptr == NULL) {
return false; return false;
}
card_ptr->atr_len = 0; card_ptr->atr_len = 0;
@ -724,13 +773,15 @@ bool GetATR(smart_card_atr_t *card_ptr, bool verbose) {
//wait for sim card to answer. //wait for sim card to answer.
// 1byte = 1ms , max frame 256bytes. Should wait 256ms atleast just in case. // 1byte = 1ms , max frame 256bytes. Should wait 256ms atleast just in case.
if (I2C_WaitForSim(SIM_WAIT_DELAY) == false) if (I2C_WaitForSim(SIM_WAIT_DELAY) == false) {
return false; return false;
}
// read bytes from module // read bytes from module
uint16_t len = sizeof(card_ptr->atr); uint16_t len = sizeof(card_ptr->atr);
if (sc_rx_bytes(card_ptr->atr, &len, SIM_WAIT_DELAY) == false) if (sc_rx_bytes(card_ptr->atr, &len, SIM_WAIT_DELAY) == false) {
return false; return false;
}
if (len > sizeof(card_ptr->atr)) { if (len > sizeof(card_ptr->atr)) {
len = sizeof(card_ptr->atr); len = sizeof(card_ptr->atr);