mirror of
https://github.com/Proxmark/proxmark3.git
synced 2025-08-22 22:23:38 -07:00
Merge branch 'master' into Magic_MF_Detect
This commit is contained in:
commit
473d745309
17 changed files with 1107 additions and 682 deletions
|
@ -22,6 +22,9 @@ This project uses the changelog in accordance with [keepchangelog](http://keepac
|
||||||
|
|
||||||
## [3.0.0][2017-06-05]
|
## [3.0.0][2017-06-05]
|
||||||
|
|
||||||
|
### Added
|
||||||
|
- Added lf hitag write 24, the command writes a block to hitag2 tags in crypto mode (henjo)
|
||||||
|
|
||||||
### Added
|
### Added
|
||||||
- Added hf mf hardnested, an attack working for hardened Mifare cards (EV1, Mifare Plus SL1) where hf mf nested fails
|
- Added hf mf hardnested, an attack working for hardened Mifare cards (EV1, Mifare Plus SL1) where hf mf nested fails
|
||||||
- Added experimental testmode write option for t55xx (danger) (marshmellow)
|
- Added experimental testmode write option for t55xx (danger) (marshmellow)
|
||||||
|
|
|
@ -1051,7 +1051,12 @@ void UsbPacketReceived(uint8_t *packet, int len)
|
||||||
ReadHitagS((hitag_function)c->arg[0],(hitag_data*)c->d.asBytes);
|
ReadHitagS((hitag_function)c->arg[0],(hitag_data*)c->d.asBytes);
|
||||||
break;
|
break;
|
||||||
case CMD_WR_HITAG_S://writer for Hitag tags args=data to write,page and key or challenge
|
case CMD_WR_HITAG_S://writer for Hitag tags args=data to write,page and key or challenge
|
||||||
WritePageHitagS((hitag_function)c->arg[0],(hitag_data*)c->d.asBytes,c->arg[2]);
|
if ((hitag_function)c->arg[0] < 10) {
|
||||||
|
WritePageHitagS((hitag_function)c->arg[0],(hitag_data*)c->d.asBytes,c->arg[2]);
|
||||||
|
}
|
||||||
|
else if ((hitag_function)c->arg[0] >= 10) {
|
||||||
|
WriterHitag((hitag_function)c->arg[0],(hitag_data*)c->d.asBytes, c->arg[2]);
|
||||||
|
}
|
||||||
break;
|
break;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
|
|
@ -182,6 +182,7 @@ void iClass_ReadCheck(uint8_t blockNo, uint8_t keyType);
|
||||||
void SnoopHitag(uint32_t type);
|
void SnoopHitag(uint32_t type);
|
||||||
void SimulateHitagTag(bool tag_mem_supplied, byte_t* data);
|
void SimulateHitagTag(bool tag_mem_supplied, byte_t* data);
|
||||||
void ReaderHitag(hitag_function htf, hitag_data* htd);
|
void ReaderHitag(hitag_function htf, hitag_data* htd);
|
||||||
|
void WriterHitag(hitag_function htf, hitag_data* htd, int page);
|
||||||
|
|
||||||
//hitagS.h
|
//hitagS.h
|
||||||
void SimulateHitagSTag(bool tag_mem_supplied, byte_t* data);
|
void SimulateHitagSTag(bool tag_mem_supplied, byte_t* data);
|
||||||
|
|
1142
armsrc/hitag2.c
1142
armsrc/hitag2.c
File diff suppressed because it is too large
Load diff
|
@ -49,6 +49,7 @@
|
||||||
#include "iso15693tools.h"
|
#include "iso15693tools.h"
|
||||||
#include "protocols.h"
|
#include "protocols.h"
|
||||||
#include "optimized_cipher.h"
|
#include "optimized_cipher.h"
|
||||||
|
#include "usb_cdc.h" // for usb_poll_validate_length
|
||||||
|
|
||||||
static int timeout = 4096;
|
static int timeout = 4096;
|
||||||
|
|
||||||
|
@ -1681,7 +1682,7 @@ void ReaderIClass(uint8_t arg0) {
|
||||||
|
|
||||||
uint8_t card_data[6 * 8]={0};
|
uint8_t card_data[6 * 8]={0};
|
||||||
memset(card_data, 0xFF, sizeof(card_data));
|
memset(card_data, 0xFF, sizeof(card_data));
|
||||||
uint8_t last_csn[8]={0};
|
uint8_t last_csn[8]={0,0,0,0,0,0,0,0};
|
||||||
uint8_t resp[ICLASS_BUFFER_SIZE];
|
uint8_t resp[ICLASS_BUFFER_SIZE];
|
||||||
memset(resp, 0xFF, sizeof(resp));
|
memset(resp, 0xFF, sizeof(resp));
|
||||||
//Read conf block CRC(0x01) => 0xfa 0x22
|
//Read conf block CRC(0x01) => 0xfa 0x22
|
||||||
|
@ -1707,9 +1708,11 @@ void ReaderIClass(uint8_t arg0) {
|
||||||
setupIclassReader();
|
setupIclassReader();
|
||||||
|
|
||||||
uint16_t tryCnt=0;
|
uint16_t tryCnt=0;
|
||||||
while(!BUTTON_PRESS())
|
bool userCancelled = BUTTON_PRESS() || usb_poll_validate_length();
|
||||||
|
while(!userCancelled)
|
||||||
{
|
{
|
||||||
if (try_once && tryCnt > 5) break;
|
// if only looking for one card try 2 times if we missed it the first time
|
||||||
|
if (try_once && tryCnt > 2) break;
|
||||||
tryCnt++;
|
tryCnt++;
|
||||||
if(!tracing) {
|
if(!tracing) {
|
||||||
DbpString("Trace full");
|
DbpString("Trace full");
|
||||||
|
@ -1759,7 +1762,8 @@ void ReaderIClass(uint8_t arg0) {
|
||||||
// with 0xFF:s in block 3 and 4.
|
// with 0xFF:s in block 3 and 4.
|
||||||
|
|
||||||
LED_B_ON();
|
LED_B_ON();
|
||||||
//Send back to client, but don't bother if we already sent this
|
//Send back to client, but don't bother if we already sent this -
|
||||||
|
// only useful if looping in arm (not try_once && not abort_after_read)
|
||||||
if(memcmp(last_csn, card_data, 8) != 0)
|
if(memcmp(last_csn, card_data, 8) != 0)
|
||||||
{
|
{
|
||||||
// If caller requires that we get Conf, CC, AA, continue until we got it
|
// If caller requires that we get Conf, CC, AA, continue until we got it
|
||||||
|
@ -1767,6 +1771,7 @@ void ReaderIClass(uint8_t arg0) {
|
||||||
cmd_send(CMD_ACK,result_status,0,0,card_data,sizeof(card_data));
|
cmd_send(CMD_ACK,result_status,0,0,card_data,sizeof(card_data));
|
||||||
if(abort_after_read) {
|
if(abort_after_read) {
|
||||||
LED_A_OFF();
|
LED_A_OFF();
|
||||||
|
LED_B_OFF();
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
//Save that we already sent this....
|
//Save that we already sent this....
|
||||||
|
@ -1775,8 +1780,13 @@ void ReaderIClass(uint8_t arg0) {
|
||||||
|
|
||||||
}
|
}
|
||||||
LED_B_OFF();
|
LED_B_OFF();
|
||||||
|
userCancelled = BUTTON_PRESS() || usb_poll_validate_length();
|
||||||
|
}
|
||||||
|
if (userCancelled) {
|
||||||
|
cmd_send(CMD_ACK,0xFF,0,0,card_data, 0);
|
||||||
|
} else {
|
||||||
|
cmd_send(CMD_ACK,0,0,0,card_data, 0);
|
||||||
}
|
}
|
||||||
cmd_send(CMD_ACK,0,0,0,card_data, 0);
|
|
||||||
LED_A_OFF();
|
LED_A_OFF();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -13,13 +13,13 @@ RM = rm -f
|
||||||
MV = mv
|
MV = mv
|
||||||
|
|
||||||
#COMMON_FLAGS = -m32
|
#COMMON_FLAGS = -m32
|
||||||
VPATH = ../common ../zlib
|
VPATH = ../common ../zlib ../uart
|
||||||
OBJDIR = obj
|
OBJDIR = obj
|
||||||
|
|
||||||
LDLIBS = -L/opt/local/lib -L/usr/local/lib -lreadline -lpthread -lm
|
LDLIBS = -L/opt/local/lib -L/usr/local/lib -lreadline -lpthread -lm
|
||||||
LUALIB = ../liblua/liblua.a
|
LUALIB = ../liblua/liblua.a
|
||||||
LDFLAGS = $(COMMON_FLAGS)
|
LDFLAGS = $(COMMON_FLAGS)
|
||||||
CFLAGS = -std=c99 -D_ISOC99_SOURCE -I. -I../include -I../common -I../zlib -I/opt/local/include -I../liblua -Wall $(COMMON_FLAGS) -g -O3
|
CFLAGS = -std=c99 -D_ISOC99_SOURCE -I. -I../include -I../common -I../zlib -I../uart -I/opt/local/include -I../liblua -Wall $(COMMON_FLAGS) -g -O3
|
||||||
CXXFLAGS = -I../include -Wall -O3
|
CXXFLAGS = -I../include -Wall -O3
|
||||||
|
|
||||||
LUAPLATFORM = generic
|
LUAPLATFORM = generic
|
||||||
|
@ -78,7 +78,8 @@ DEPFLAGS = -MT $@ -MMD -MP -MF $(OBJDIR)/$*.Td
|
||||||
# make temporary to final dependeny files after successful compilation
|
# make temporary to final dependeny files after successful compilation
|
||||||
POSTCOMPILE = $(MV) -f $(OBJDIR)/$*.Td $(OBJDIR)/$*.d
|
POSTCOMPILE = $(MV) -f $(OBJDIR)/$*.Td $(OBJDIR)/$*.d
|
||||||
|
|
||||||
CORESRCS = uart.c \
|
CORESRCS = uart_posix.c \
|
||||||
|
uart_win32.c \
|
||||||
util.c \
|
util.c \
|
||||||
util_posix.c
|
util_posix.c
|
||||||
|
|
||||||
|
|
|
@ -673,16 +673,17 @@ int CmdHFSearch(const char *Cmd){
|
||||||
PrintAndLog("\nValid iClass Tag (or PicoPass Tag) Found - Quiting Search\n");
|
PrintAndLog("\nValid iClass Tag (or PicoPass Tag) Found - Quiting Search\n");
|
||||||
return ans;
|
return ans;
|
||||||
}
|
}
|
||||||
ans = HF14BInfo(false);
|
|
||||||
if (ans) {
|
|
||||||
PrintAndLog("\nValid ISO14443B Tag Found - Quiting Search\n");
|
|
||||||
return ans;
|
|
||||||
}
|
|
||||||
ans = HF15Reader("", false);
|
ans = HF15Reader("", false);
|
||||||
if (ans) {
|
if (ans) {
|
||||||
PrintAndLog("\nValid ISO15693 Tag Found - Quiting Search\n");
|
PrintAndLog("\nValid ISO15693 Tag Found - Quiting Search\n");
|
||||||
return ans;
|
return ans;
|
||||||
}
|
}
|
||||||
|
//14b is longest test currently (and rarest chip type) ... put last
|
||||||
|
ans = HF14BInfo(false);
|
||||||
|
if (ans) {
|
||||||
|
PrintAndLog("\nValid ISO14443B Tag Found - Quiting Search\n");
|
||||||
|
return ans;
|
||||||
|
}
|
||||||
PrintAndLog("\nno known/supported 13.56 MHz tags found\n");
|
PrintAndLog("\nno known/supported 13.56 MHz tags found\n");
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
|
@ -191,8 +191,12 @@ int HFiClassReader(const char *Cmd, bool loop, bool verbose) {
|
||||||
uint8_t readStatus = resp.arg[0] & 0xff;
|
uint8_t readStatus = resp.arg[0] & 0xff;
|
||||||
uint8_t *data = resp.d.asBytes;
|
uint8_t *data = resp.d.asBytes;
|
||||||
|
|
||||||
// no tag found
|
// no tag found or button pressed
|
||||||
if( readStatus == 0) continue;
|
if( (readStatus == 0 && !loop) || readStatus == 0xFF) {
|
||||||
|
// abort
|
||||||
|
if (verbose) PrintAndLog("Quitting...");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
if( readStatus & FLAG_ICLASS_READER_CSN) {
|
if( readStatus & FLAG_ICLASS_READER_CSN) {
|
||||||
PrintAndLog(" CSN: %s",sprint_hex(data,8));
|
PrintAndLog(" CSN: %s",sprint_hex(data,8));
|
||||||
|
@ -1708,7 +1712,7 @@ static command_t CommandTable[] =
|
||||||
{"loclass", CmdHFiClass_loclass, 1, "[options..] Use loclass to perform bruteforce of reader attack dump"},
|
{"loclass", CmdHFiClass_loclass, 1, "[options..] Use loclass to perform bruteforce of reader attack dump"},
|
||||||
{"managekeys", CmdHFiClassManageKeys, 1, "[options..] Manage the keys to use with iClass"},
|
{"managekeys", CmdHFiClassManageKeys, 1, "[options..] Manage the keys to use with iClass"},
|
||||||
{"readblk", CmdHFiClass_ReadBlock, 0, "[options..] Authenticate and Read iClass block"},
|
{"readblk", CmdHFiClass_ReadBlock, 0, "[options..] Authenticate and Read iClass block"},
|
||||||
{"reader", CmdHFiClassReader, 0, " Read an iClass tag"},
|
{"reader", CmdHFiClassReader, 0, " Look for iClass tags until a key or the pm3 button is pressed"},
|
||||||
{"readtagfile", CmdHFiClassReadTagFile, 1, "[options..] Display Content from tagfile"},
|
{"readtagfile", CmdHFiClassReadTagFile, 1, "[options..] Display Content from tagfile"},
|
||||||
{"replay", CmdHFiClassReader_Replay, 0, "<mac> Read an iClass tag via Reply Attack"},
|
{"replay", CmdHFiClassReader_Replay, 0, "<mac> Read an iClass tag via Reply Attack"},
|
||||||
{"sim", CmdHFiClassSim, 0, "[options..] Simulate iClass tag"},
|
{"sim", CmdHFiClassSim, 0, "[options..] Simulate iClass tag"},
|
||||||
|
|
|
@ -405,7 +405,7 @@ int CmdEM410xBrute(const char *Cmd)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
sprintf(testuid, "%010lX", bytes_to_num(uidBlock + 5*c, 5));
|
sprintf(testuid, "%010" PRIX64, bytes_to_num(uidBlock + 5*c, 5));
|
||||||
PrintAndLog("Bruteforce %d / %d: simulating UID %s, clock %d", c + 1, uidcnt, testuid, clock);
|
PrintAndLog("Bruteforce %d / %d: simulating UID %s, clock %d", c + 1, uidcnt, testuid, clock);
|
||||||
|
|
||||||
ConstructEM410xEmulGraph(testuid, clock);
|
ConstructEM410xEmulGraph(testuid, clock);
|
||||||
|
|
|
@ -349,7 +349,9 @@ int CmdLFHitagWP(const char *Cmd) {
|
||||||
c.arg[2]= param_get32ex(Cmd, 2, 0, 10);
|
c.arg[2]= param_get32ex(Cmd, 2, 0, 10);
|
||||||
num_to_bytes(param_get32ex(Cmd,3,0,16),4,htd->auth.data);
|
num_to_bytes(param_get32ex(Cmd,3,0,16),4,htd->auth.data);
|
||||||
} break;
|
} break;
|
||||||
case 04: { //WHTSF_KEY
|
case 04:
|
||||||
|
case 24:
|
||||||
|
{ //WHTSF_KEY
|
||||||
num_to_bytes(param_get64ex(Cmd,1,0,16),6,htd->crypto.key);
|
num_to_bytes(param_get64ex(Cmd,1,0,16),6,htd->crypto.key);
|
||||||
c.arg[2]= param_get32ex(Cmd, 2, 0, 10);
|
c.arg[2]= param_get32ex(Cmd, 2, 0, 10);
|
||||||
num_to_bytes(param_get32ex(Cmd,3,0,16),4,htd->crypto.data);
|
num_to_bytes(param_get32ex(Cmd,3,0,16),4,htd->crypto.data);
|
||||||
|
@ -363,6 +365,7 @@ int CmdLFHitagWP(const char *Cmd) {
|
||||||
PrintAndLog(" 04 <key> (set to 0 if no authentication is needed) <page> <byte0...byte3> write page on a Hitag S tag");
|
PrintAndLog(" 04 <key> (set to 0 if no authentication is needed) <page> <byte0...byte3> write page on a Hitag S tag");
|
||||||
PrintAndLog(" Hitag1 (1*)");
|
PrintAndLog(" Hitag1 (1*)");
|
||||||
PrintAndLog(" Hitag2 (2*)");
|
PrintAndLog(" Hitag2 (2*)");
|
||||||
|
PrintAndLog(" 24 <key> (set to 0 if no authentication is needed) <page> <byte0...byte3> write page on a Hitag S tag");
|
||||||
return 1;
|
return 1;
|
||||||
} break;
|
} break;
|
||||||
}
|
}
|
||||||
|
|
|
@ -19,6 +19,8 @@
|
||||||
|
|
||||||
#ifdef _WIN32
|
#ifdef _WIN32
|
||||||
# define unlink(x)
|
# define unlink(x)
|
||||||
|
#else
|
||||||
|
# include <unistd.h>
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
static serial_port sp;
|
static serial_port sp;
|
||||||
|
@ -52,8 +54,7 @@ void ReceiveCommand(UsbCommand* rxcmd) {
|
||||||
byte_t* prx = prxcmd;
|
byte_t* prx = prxcmd;
|
||||||
size_t rxlen;
|
size_t rxlen;
|
||||||
while (true) {
|
while (true) {
|
||||||
rxlen = sizeof(UsbCommand) - (prx-prxcmd);
|
if (uart_receive(sp, prx, sizeof(UsbCommand) - (prx-prxcmd), &rxlen)) {
|
||||||
if (uart_receive(sp,prx,&rxlen)) {
|
|
||||||
prx += rxlen;
|
prx += rxlen;
|
||||||
if ((prx-prxcmd) >= sizeof(UsbCommand)) {
|
if ((prx-prxcmd) >= sizeof(UsbCommand)) {
|
||||||
return;
|
return;
|
||||||
|
@ -129,7 +130,7 @@ int main(int argc, char **argv)
|
||||||
|
|
||||||
fprintf(stderr,"Waiting for Proxmark to appear on %s",serial_port_name);
|
fprintf(stderr,"Waiting for Proxmark to appear on %s",serial_port_name);
|
||||||
do {
|
do {
|
||||||
sleep(1);
|
msleep(1000);
|
||||||
fprintf(stderr, ".");
|
fprintf(stderr, ".");
|
||||||
} while (!OpenProxmark(0));
|
} while (!OpenProxmark(0));
|
||||||
fprintf(stderr," Found.\n");
|
fprintf(stderr," Found.\n");
|
||||||
|
|
|
@ -57,26 +57,22 @@ struct receiver_arg {
|
||||||
int run;
|
int run;
|
||||||
};
|
};
|
||||||
|
|
||||||
byte_t rx[0x1000000];
|
byte_t rx[sizeof(UsbCommand)];
|
||||||
byte_t* prx = rx;
|
byte_t* prx = rx;
|
||||||
|
|
||||||
static void *uart_receiver(void *targ) {
|
static void *uart_receiver(void *targ) {
|
||||||
struct receiver_arg *arg = (struct receiver_arg*)targ;
|
struct receiver_arg *arg = (struct receiver_arg*)targ;
|
||||||
size_t rxlen;
|
size_t rxlen;
|
||||||
size_t cmd_count;
|
|
||||||
|
|
||||||
while (arg->run) {
|
while (arg->run) {
|
||||||
rxlen = sizeof(UsbCommand);
|
rxlen = 0;
|
||||||
if (uart_receive(sp, prx, &rxlen)) {
|
if (uart_receive(sp, prx, sizeof(UsbCommand) - (prx-rx), &rxlen)) {
|
||||||
prx += rxlen;
|
prx += rxlen;
|
||||||
if (((prx-rx) % sizeof(UsbCommand)) != 0) {
|
if (prx-rx < sizeof(UsbCommand)) {
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
cmd_count = (prx-rx) / sizeof(UsbCommand);
|
|
||||||
|
UsbCommandReceived((UsbCommand*)rx);
|
||||||
for (size_t i = 0; i < cmd_count; i++) {
|
|
||||||
UsbCommandReceived((UsbCommand*)(rx+(i*sizeof(UsbCommand))));
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
prx = rx;
|
prx = rx;
|
||||||
|
|
||||||
|
|
|
@ -27,8 +27,9 @@ typedef enum {
|
||||||
RHT2F_PASSWORD = 21,
|
RHT2F_PASSWORD = 21,
|
||||||
RHT2F_AUTHENTICATE = 22,
|
RHT2F_AUTHENTICATE = 22,
|
||||||
RHT2F_CRYPTO = 23,
|
RHT2F_CRYPTO = 23,
|
||||||
|
WHT2F_CRYPTO = 24,
|
||||||
RHT2F_TEST_AUTH_ATTEMPTS = 25,
|
RHT2F_TEST_AUTH_ATTEMPTS = 25,
|
||||||
RHT2F_UID_ONLY = 26
|
RHT2F_UID_ONLY = 26,
|
||||||
} hitag_function;
|
} hitag_function;
|
||||||
|
|
||||||
typedef struct {
|
typedef struct {
|
||||||
|
|
13
uart/README.md
Normal file
13
uart/README.md
Normal file
|
@ -0,0 +1,13 @@
|
||||||
|
# uart
|
||||||
|
|
||||||
|
This contains functionality for talking to UART/Serial devices on different platforms. The official client will build either `uart_posix.c` and `uart_win32.c`. Build targets for these files are contained in `client/Makefile`.
|
||||||
|
|
||||||
|
If you want to implement support for other platforms, you need to implement the methods provided in `uart.h`.
|
||||||
|
|
||||||
|
## Implementing a new driver
|
||||||
|
|
||||||
|
Each driver is called with a string, typically containing a path or other reference to a serial port on the host. The methods outlined in `uart.h` need to be implemented.
|
||||||
|
|
||||||
|
The hardware uses `common/usb_cdc.c` to implement a USB CDC endpoint exposed by the Atmel MCU.
|
||||||
|
|
||||||
|
|
|
@ -27,12 +27,10 @@
|
||||||
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
*
|
*
|
||||||
* @file uart.h
|
* @file uart.h
|
||||||
* @brief
|
|
||||||
*
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef _RS232_H_
|
#ifndef _PM3_UART_H_
|
||||||
#define _RS232_H_
|
#define _PM3_UART_H_
|
||||||
|
|
||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
|
@ -43,45 +41,58 @@
|
||||||
|
|
||||||
typedef unsigned char byte_t;
|
typedef unsigned char byte_t;
|
||||||
|
|
||||||
// Handle platform specific includes
|
/* serial_port is declared as a void*, which you should cast to whatever type
|
||||||
#ifndef _WIN32
|
* makes sense to your connection method. Both the posix and win32
|
||||||
#include <termios.h>
|
* implementations define their own structs in place.
|
||||||
#include <sys/ioctl.h>
|
*/
|
||||||
#include <unistd.h>
|
|
||||||
#include <fcntl.h>
|
|
||||||
#include <sys/types.h>
|
|
||||||
#include <sys/stat.h>
|
|
||||||
#include <limits.h>
|
|
||||||
#include <sys/time.h>
|
|
||||||
#include <errno.h>
|
|
||||||
#else
|
|
||||||
#include <windows.h>
|
|
||||||
#endif
|
|
||||||
|
|
||||||
typedef enum {
|
|
||||||
SP_INVALID = 0x00, // invalid value, error occured
|
|
||||||
SP_NONE = 0x01, // no parity (default)
|
|
||||||
SP_EVEN = 0x02, // even parity
|
|
||||||
SP_ODD = 0x03 // odd parity
|
|
||||||
} serial_port_parity;
|
|
||||||
|
|
||||||
// Define shortcut to types to make code more readable
|
|
||||||
typedef void* serial_port;
|
typedef void* serial_port;
|
||||||
|
|
||||||
|
/* Returned by uart_open if the serial port specified was invalid.
|
||||||
|
*/
|
||||||
#define INVALID_SERIAL_PORT (void*)(~1)
|
#define INVALID_SERIAL_PORT (void*)(~1)
|
||||||
|
|
||||||
|
/* Returned by uart_open if the serial port specified is in use by another
|
||||||
|
* process.
|
||||||
|
*/
|
||||||
#define CLAIMED_SERIAL_PORT (void*)(~2)
|
#define CLAIMED_SERIAL_PORT (void*)(~2)
|
||||||
|
|
||||||
|
/* Given a user-specified port name, connect to the port and return a structure
|
||||||
|
* used for future references to that port.
|
||||||
|
*
|
||||||
|
* On errors, this method returns INVALID_SERIAL_PORT or CLAIMED_SERIAL_PORT.
|
||||||
|
*/
|
||||||
serial_port uart_open(const char* pcPortName);
|
serial_port uart_open(const char* pcPortName);
|
||||||
|
|
||||||
|
/* Closes the given port.
|
||||||
|
*/
|
||||||
void uart_close(const serial_port sp);
|
void uart_close(const serial_port sp);
|
||||||
|
|
||||||
bool uart_set_speed(serial_port sp, const uint32_t uiPortSpeed);
|
/* Reads from the given serial port for up to 30ms.
|
||||||
uint32_t uart_get_speed(const serial_port sp);
|
* pbtRx: A pointer to a buffer for the returned data to be written to.
|
||||||
|
* pszMaxRxLen: The maximum data size we want to be sent.
|
||||||
|
* pszRxLen: The number of bytes that we were actually sent.
|
||||||
|
*
|
||||||
|
* Returns TRUE if any data was fetched, even if it was less than pszMaxRxLen.
|
||||||
|
*
|
||||||
|
* Returns FALSE if there was an error reading from the device. Note that a
|
||||||
|
* partial read may have completed into the buffer by the corresponding
|
||||||
|
* implementation, so pszRxLen should be checked to see if any data was written.
|
||||||
|
*/
|
||||||
|
bool uart_receive(const serial_port sp, byte_t* pbtRx, size_t pszMaxRxLen, size_t* pszRxLen);
|
||||||
|
|
||||||
bool uart_set_parity(serial_port sp, serial_port_parity spp);
|
/* Sends a buffer to a given serial port.
|
||||||
serial_port_parity uart_get_parity(const serial_port sp);
|
* pbtTx: A pointer to a buffer containing the data to send.
|
||||||
|
* szTxLen: The amount of data to be sent.
|
||||||
bool uart_receive(const serial_port sp, byte_t* pbtRx, size_t* pszRxLen);
|
*/
|
||||||
bool uart_send(const serial_port sp, const byte_t* pbtTx, const size_t szTxLen);
|
bool uart_send(const serial_port sp, const byte_t* pbtTx, const size_t szTxLen);
|
||||||
|
|
||||||
#endif // _PROXMARK3_RS232_H_
|
/* Sets the current speed of the serial port, in baud.
|
||||||
|
*/
|
||||||
|
bool uart_set_speed(serial_port sp, const uint32_t uiPortSpeed);
|
||||||
|
|
||||||
|
/* Gets the current speed of the serial port, in baud.
|
||||||
|
*/
|
||||||
|
uint32_t uart_get_speed(const serial_port sp);
|
||||||
|
|
||||||
|
#endif // _PM3_UART_H_
|
||||||
|
|
|
@ -26,17 +26,26 @@
|
||||||
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||||
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
*
|
*
|
||||||
* @file uart.c
|
* @file uart_posix.c
|
||||||
* @brief
|
|
||||||
*
|
*
|
||||||
|
* This version of the library has functionality removed which was not used by
|
||||||
|
* proxmark3 project.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include "uart.h"
|
#include "uart.h"
|
||||||
|
|
||||||
// Test if we are dealing with unix operating systems
|
// Test if we are dealing with posix operating systems
|
||||||
#ifndef _WIN32
|
#ifndef _WIN32
|
||||||
|
|
||||||
#include <termios.h>
|
#include <termios.h>
|
||||||
|
#include <sys/ioctl.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <fcntl.h>
|
||||||
|
#include <sys/types.h>
|
||||||
|
#include <sys/stat.h>
|
||||||
|
#include <limits.h>
|
||||||
|
#include <sys/time.h>
|
||||||
|
#include <errno.h>
|
||||||
|
|
||||||
typedef struct termios term_info;
|
typedef struct termios term_info;
|
||||||
typedef struct {
|
typedef struct {
|
||||||
int fd; // Serial port file descriptor
|
int fd; // Serial port file descriptor
|
||||||
|
@ -124,6 +133,99 @@ void uart_close(const serial_port sp) {
|
||||||
free(sp);
|
free(sp);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
bool uart_receive(const serial_port sp, byte_t* pbtRx, size_t pszMaxRxLen, size_t* pszRxLen) {
|
||||||
|
int res;
|
||||||
|
int byteCount;
|
||||||
|
fd_set rfds;
|
||||||
|
struct timeval tv;
|
||||||
|
|
||||||
|
// Reset the output count
|
||||||
|
*pszRxLen = 0;
|
||||||
|
|
||||||
|
do {
|
||||||
|
// Reset file descriptor
|
||||||
|
FD_ZERO(&rfds);
|
||||||
|
FD_SET(((serial_port_unix*)sp)->fd,&rfds);
|
||||||
|
tv = timeout;
|
||||||
|
res = select(((serial_port_unix*)sp)->fd+1, &rfds, NULL, NULL, &tv);
|
||||||
|
|
||||||
|
// Read error
|
||||||
|
if (res < 0) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Read time-out
|
||||||
|
if (res == 0) {
|
||||||
|
if (*pszRxLen == 0) {
|
||||||
|
// Error, we received no data
|
||||||
|
return false;
|
||||||
|
} else {
|
||||||
|
// We received some data, but nothing more is available
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// Retrieve the count of the incoming bytes
|
||||||
|
res = ioctl(((serial_port_unix*)sp)->fd, FIONREAD, &byteCount);
|
||||||
|
if (res < 0) return false;
|
||||||
|
|
||||||
|
// Cap the number of bytes, so we don't overrun the buffer
|
||||||
|
if (pszMaxRxLen - (*pszRxLen) < byteCount) {
|
||||||
|
byteCount = pszMaxRxLen - (*pszRxLen);
|
||||||
|
}
|
||||||
|
|
||||||
|
// There is something available, read the data
|
||||||
|
res = read(((serial_port_unix*)sp)->fd, pbtRx+(*pszRxLen), byteCount);
|
||||||
|
|
||||||
|
// Stop if the OS has some troubles reading the data
|
||||||
|
if (res <= 0) return false;
|
||||||
|
|
||||||
|
*pszRxLen += res;
|
||||||
|
|
||||||
|
if (*pszRxLen == pszMaxRxLen) {
|
||||||
|
// We have all the data we wanted.
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
} while (byteCount);
|
||||||
|
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool uart_send(const serial_port sp, const byte_t* pbtTx, const size_t szTxLen) {
|
||||||
|
int32_t res;
|
||||||
|
size_t szPos = 0;
|
||||||
|
fd_set rfds;
|
||||||
|
struct timeval tv;
|
||||||
|
|
||||||
|
while (szPos < szTxLen) {
|
||||||
|
// Reset file descriptor
|
||||||
|
FD_ZERO(&rfds);
|
||||||
|
FD_SET(((serial_port_unix*)sp)->fd,&rfds);
|
||||||
|
tv = timeout;
|
||||||
|
res = select(((serial_port_unix*)sp)->fd+1, NULL, &rfds, NULL, &tv);
|
||||||
|
|
||||||
|
// Write error
|
||||||
|
if (res < 0) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Write time-out
|
||||||
|
if (res == 0) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Send away the bytes
|
||||||
|
res = write(((serial_port_unix*)sp)->fd,pbtTx+szPos,szTxLen-szPos);
|
||||||
|
|
||||||
|
// Stop if the OS has some troubles sending the data
|
||||||
|
if (res <= 0) return false;
|
||||||
|
|
||||||
|
szPos += res;
|
||||||
|
}
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
bool uart_set_speed(serial_port sp, const uint32_t uiPortSpeed) {
|
bool uart_set_speed(serial_port sp, const uint32_t uiPortSpeed) {
|
||||||
const serial_port_unix* spu = (serial_port_unix*)sp;
|
const serial_port_unix* spu = (serial_port_unix*)sp;
|
||||||
speed_t stPortSpeed;
|
speed_t stPortSpeed;
|
||||||
|
@ -211,220 +313,5 @@ uint32_t uart_get_speed(const serial_port sp) {
|
||||||
return uiPortSpeed;
|
return uiPortSpeed;
|
||||||
}
|
}
|
||||||
|
|
||||||
bool uart_set_parity(serial_port sp, serial_port_parity spp) {
|
|
||||||
struct termios ti;
|
|
||||||
const serial_port_unix* spu = (serial_port_unix*)sp;
|
|
||||||
if (tcgetattr(spu->fd,&ti) == -1) return false;
|
|
||||||
switch(spp) {
|
|
||||||
case SP_INVALID: return false;
|
|
||||||
case SP_NONE: ti.c_cflag &= ~(PARENB | PARODD); break;
|
|
||||||
case SP_EVEN: ti.c_cflag |= PARENB; ti.c_cflag &= ~(PARODD); break;
|
|
||||||
case SP_ODD: ti.c_cflag |= PARENB | PARODD; break;
|
|
||||||
}
|
|
||||||
return (tcsetattr(spu->fd,TCSANOW,&ti) != -1);
|
|
||||||
}
|
|
||||||
|
|
||||||
serial_port_parity uart_get_parity(const serial_port sp) {
|
|
||||||
struct termios ti;
|
|
||||||
const serial_port_unix* spu = (serial_port_unix*)sp;
|
|
||||||
if (tcgetattr(spu->fd,&ti) == -1) return SP_INVALID;
|
|
||||||
|
|
||||||
if (ti.c_cflag & PARENB) {
|
|
||||||
if (ti.c_cflag & PARODD) {
|
|
||||||
return SP_ODD;
|
|
||||||
} else {
|
|
||||||
return SP_EVEN;
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
return SP_NONE;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
bool uart_cts(const serial_port sp) {
|
|
||||||
char status;
|
|
||||||
if (ioctl(((serial_port_unix*)sp)->fd,TIOCMGET,&status) < 0) return false;
|
|
||||||
return (status & TIOCM_CTS);
|
|
||||||
}
|
|
||||||
|
|
||||||
bool uart_receive(const serial_port sp, byte_t* pbtRx, size_t* pszRxLen) {
|
|
||||||
|
|
||||||
int res;
|
|
||||||
int byteCount;
|
|
||||||
fd_set rfds;
|
|
||||||
struct timeval tv;
|
|
||||||
|
|
||||||
// Reset the output count
|
|
||||||
*pszRxLen = 0;
|
|
||||||
|
|
||||||
do {
|
|
||||||
// Reset file descriptor
|
|
||||||
FD_ZERO(&rfds);
|
|
||||||
FD_SET(((serial_port_unix*)sp)->fd,&rfds);
|
|
||||||
tv = timeout;
|
|
||||||
res = select(((serial_port_unix*)sp)->fd+1, &rfds, NULL, NULL, &tv);
|
|
||||||
|
|
||||||
// Read error
|
|
||||||
if (res < 0) {
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Read time-out
|
|
||||||
if (res == 0) {
|
|
||||||
if (*pszRxLen == 0) {
|
|
||||||
// Error, we received no data
|
|
||||||
return false;
|
|
||||||
} else {
|
|
||||||
// We received some data, but nothing more is available
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// Retrieve the count of the incoming bytes
|
|
||||||
res = ioctl(((serial_port_unix*)sp)->fd, FIONREAD, &byteCount);
|
|
||||||
if (res < 0) return false;
|
|
||||||
|
|
||||||
// There is something available, read the data
|
|
||||||
res = read(((serial_port_unix*)sp)->fd,pbtRx+(*pszRxLen),byteCount);
|
|
||||||
|
|
||||||
// Stop if the OS has some troubles reading the data
|
|
||||||
if (res <= 0) return false;
|
|
||||||
|
|
||||||
*pszRxLen += res;
|
|
||||||
|
|
||||||
if(res==byteCount)
|
|
||||||
return true;
|
|
||||||
|
|
||||||
} while (byteCount);
|
|
||||||
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
|
|
||||||
bool uart_send(const serial_port sp, const byte_t* pbtTx, const size_t szTxLen) {
|
|
||||||
int32_t res;
|
|
||||||
size_t szPos = 0;
|
|
||||||
fd_set rfds;
|
|
||||||
struct timeval tv;
|
|
||||||
|
|
||||||
while (szPos < szTxLen) {
|
|
||||||
// Reset file descriptor
|
|
||||||
FD_ZERO(&rfds);
|
|
||||||
FD_SET(((serial_port_unix*)sp)->fd,&rfds);
|
|
||||||
tv = timeout;
|
|
||||||
res = select(((serial_port_unix*)sp)->fd+1, NULL, &rfds, NULL, &tv);
|
|
||||||
|
|
||||||
// Write error
|
|
||||||
if (res < 0) {
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Write time-out
|
|
||||||
if (res == 0) {
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Send away the bytes
|
|
||||||
res = write(((serial_port_unix*)sp)->fd,pbtTx+szPos,szTxLen-szPos);
|
|
||||||
|
|
||||||
// Stop if the OS has some troubles sending the data
|
|
||||||
if (res <= 0) return false;
|
|
||||||
|
|
||||||
szPos += res;
|
|
||||||
}
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
|
|
||||||
#else
|
|
||||||
// The windows serial port implementation
|
|
||||||
|
|
||||||
typedef struct {
|
|
||||||
HANDLE hPort; // Serial port handle
|
|
||||||
DCB dcb; // Device control settings
|
|
||||||
COMMTIMEOUTS ct; // Serial port time-out configuration
|
|
||||||
} serial_port_windows;
|
|
||||||
|
|
||||||
void upcase(char *p) {
|
|
||||||
while(*p != '\0') {
|
|
||||||
if(*p >= 97 && *p <= 122) {
|
|
||||||
*p -= 32;
|
|
||||||
}
|
|
||||||
++p;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
serial_port uart_open(const char* pcPortName) {
|
|
||||||
char acPortName[255];
|
|
||||||
serial_port_windows* sp = malloc(sizeof(serial_port_windows));
|
|
||||||
|
|
||||||
// Copy the input "com?" to "\\.\COM?" format
|
|
||||||
sprintf(acPortName,"\\\\.\\%s",pcPortName);
|
|
||||||
upcase(acPortName);
|
|
||||||
|
|
||||||
// Try to open the serial port
|
|
||||||
sp->hPort = CreateFileA(acPortName,GENERIC_READ|GENERIC_WRITE,0,NULL,OPEN_EXISTING,0,NULL);
|
|
||||||
if (sp->hPort == INVALID_HANDLE_VALUE) {
|
|
||||||
uart_close(sp);
|
|
||||||
return INVALID_SERIAL_PORT;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Prepare the device control
|
|
||||||
memset(&sp->dcb, 0, sizeof(DCB));
|
|
||||||
sp->dcb.DCBlength = sizeof(DCB);
|
|
||||||
if(!BuildCommDCBA("baud=9600 data=8 parity=N stop=1",&sp->dcb)) {
|
|
||||||
uart_close(sp);
|
|
||||||
return INVALID_SERIAL_PORT;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Update the active serial port
|
|
||||||
if(!SetCommState(sp->hPort,&sp->dcb)) {
|
|
||||||
uart_close(sp);
|
|
||||||
return INVALID_SERIAL_PORT;
|
|
||||||
}
|
|
||||||
|
|
||||||
sp->ct.ReadIntervalTimeout = 0;
|
|
||||||
sp->ct.ReadTotalTimeoutMultiplier = 0;
|
|
||||||
sp->ct.ReadTotalTimeoutConstant = 30;
|
|
||||||
sp->ct.WriteTotalTimeoutMultiplier = 0;
|
|
||||||
sp->ct.WriteTotalTimeoutConstant = 30;
|
|
||||||
|
|
||||||
if(!SetCommTimeouts(sp->hPort,&sp->ct)) {
|
|
||||||
uart_close(sp);
|
|
||||||
return INVALID_SERIAL_PORT;
|
|
||||||
}
|
|
||||||
|
|
||||||
PurgeComm(sp->hPort, PURGE_RXABORT | PURGE_RXCLEAR);
|
|
||||||
|
|
||||||
return sp;
|
|
||||||
}
|
|
||||||
|
|
||||||
void uart_close(const serial_port sp) {
|
|
||||||
CloseHandle(((serial_port_windows*)sp)->hPort);
|
|
||||||
free(sp);
|
|
||||||
}
|
|
||||||
|
|
||||||
bool uart_set_speed(serial_port sp, const uint32_t uiPortSpeed) {
|
|
||||||
serial_port_windows* spw;
|
|
||||||
spw = (serial_port_windows*)sp;
|
|
||||||
spw->dcb.BaudRate = uiPortSpeed;
|
|
||||||
return SetCommState(spw->hPort, &spw->dcb);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint32_t uart_get_speed(const serial_port sp) {
|
|
||||||
const serial_port_windows* spw = (serial_port_windows*)sp;
|
|
||||||
if (!GetCommState(spw->hPort, (serial_port)&spw->dcb)) {
|
|
||||||
return spw->dcb.BaudRate;
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
bool uart_receive(const serial_port sp, byte_t* pbtRx, size_t* pszRxLen) {
|
|
||||||
ReadFile(((serial_port_windows*)sp)->hPort,pbtRx,*pszRxLen,(LPDWORD)pszRxLen,NULL);
|
|
||||||
return (*pszRxLen != 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
bool uart_send(const serial_port sp, const byte_t* pbtTx, const size_t szTxLen) {
|
|
||||||
DWORD dwTxLen = 0;
|
|
||||||
return WriteFile(((serial_port_windows*)sp)->hPort,pbtTx,szTxLen,&dwTxLen,NULL);
|
|
||||||
return (dwTxLen != 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
|
136
uart/uart_win32.c
Normal file
136
uart/uart_win32.c
Normal file
|
@ -0,0 +1,136 @@
|
||||||
|
/*
|
||||||
|
* Generic uart / rs232/ serial port library
|
||||||
|
*
|
||||||
|
* Copyright (c) 2013, Roel Verdult
|
||||||
|
* All rights reserved.
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions are met:
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. Neither the name of the copyright holders nor the
|
||||||
|
* names of its contributors may be used to endorse or promote products
|
||||||
|
* derived from this software without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS ''AS IS'' AND ANY
|
||||||
|
* EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
|
||||||
|
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
||||||
|
* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDERS BE LIABLE FOR ANY
|
||||||
|
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
||||||
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
||||||
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
|
||||||
|
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||||||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||||
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
* @file uart_win32.c
|
||||||
|
*
|
||||||
|
* Note: the win32 version of this library has also been seen under the GPLv3+
|
||||||
|
* license as part of the libnfc project, which appears to have additional
|
||||||
|
* contributors.
|
||||||
|
*
|
||||||
|
* This version of the library has functionality removed which was not used by
|
||||||
|
* proxmark3 project.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "uart.h"
|
||||||
|
|
||||||
|
// The windows serial port implementation
|
||||||
|
#ifdef _WIN32
|
||||||
|
#include <windows.h>
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
HANDLE hPort; // Serial port handle
|
||||||
|
DCB dcb; // Device control settings
|
||||||
|
COMMTIMEOUTS ct; // Serial port time-out configuration
|
||||||
|
} serial_port_windows;
|
||||||
|
|
||||||
|
void upcase(char *p) {
|
||||||
|
while(*p != '\0') {
|
||||||
|
if(*p >= 97 && *p <= 122) {
|
||||||
|
*p -= 32;
|
||||||
|
}
|
||||||
|
++p;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
serial_port uart_open(const char* pcPortName) {
|
||||||
|
char acPortName[255];
|
||||||
|
serial_port_windows* sp = malloc(sizeof(serial_port_windows));
|
||||||
|
|
||||||
|
// Copy the input "com?" to "\\.\COM?" format
|
||||||
|
sprintf(acPortName,"\\\\.\\%s",pcPortName);
|
||||||
|
upcase(acPortName);
|
||||||
|
|
||||||
|
// Try to open the serial port
|
||||||
|
sp->hPort = CreateFileA(acPortName,GENERIC_READ|GENERIC_WRITE,0,NULL,OPEN_EXISTING,0,NULL);
|
||||||
|
if (sp->hPort == INVALID_HANDLE_VALUE) {
|
||||||
|
uart_close(sp);
|
||||||
|
return INVALID_SERIAL_PORT;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Prepare the device control
|
||||||
|
memset(&sp->dcb, 0, sizeof(DCB));
|
||||||
|
sp->dcb.DCBlength = sizeof(DCB);
|
||||||
|
if(!BuildCommDCBA("baud=9600 data=8 parity=N stop=1",&sp->dcb)) {
|
||||||
|
uart_close(sp);
|
||||||
|
return INVALID_SERIAL_PORT;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Update the active serial port
|
||||||
|
if(!SetCommState(sp->hPort,&sp->dcb)) {
|
||||||
|
uart_close(sp);
|
||||||
|
return INVALID_SERIAL_PORT;
|
||||||
|
}
|
||||||
|
|
||||||
|
sp->ct.ReadIntervalTimeout = 0;
|
||||||
|
sp->ct.ReadTotalTimeoutMultiplier = 0;
|
||||||
|
sp->ct.ReadTotalTimeoutConstant = 30;
|
||||||
|
sp->ct.WriteTotalTimeoutMultiplier = 0;
|
||||||
|
sp->ct.WriteTotalTimeoutConstant = 30;
|
||||||
|
|
||||||
|
if(!SetCommTimeouts(sp->hPort,&sp->ct)) {
|
||||||
|
uart_close(sp);
|
||||||
|
return INVALID_SERIAL_PORT;
|
||||||
|
}
|
||||||
|
|
||||||
|
PurgeComm(sp->hPort, PURGE_RXABORT | PURGE_RXCLEAR);
|
||||||
|
|
||||||
|
return sp;
|
||||||
|
}
|
||||||
|
|
||||||
|
void uart_close(const serial_port sp) {
|
||||||
|
CloseHandle(((serial_port_windows*)sp)->hPort);
|
||||||
|
free(sp);
|
||||||
|
}
|
||||||
|
|
||||||
|
bool uart_receive(const serial_port sp, byte_t* pbtRx, size_t pszMaxRxLen, size_t* pszRxLen) {
|
||||||
|
ReadFile(((serial_port_windows*)sp)->hPort,pbtRx,pszMaxRxLen,(LPDWORD)pszRxLen,NULL);
|
||||||
|
return (*pszRxLen != 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
bool uart_send(const serial_port sp, const byte_t* pbtTx, const size_t szTxLen) {
|
||||||
|
DWORD dwTxLen = 0;
|
||||||
|
return WriteFile(((serial_port_windows*)sp)->hPort,pbtTx,szTxLen,&dwTxLen,NULL);
|
||||||
|
return (dwTxLen != 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
bool uart_set_speed(serial_port sp, const uint32_t uiPortSpeed) {
|
||||||
|
serial_port_windows* spw;
|
||||||
|
spw = (serial_port_windows*)sp;
|
||||||
|
spw->dcb.BaudRate = uiPortSpeed;
|
||||||
|
return SetCommState(spw->hPort, &spw->dcb);
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t uart_get_speed(const serial_port sp) {
|
||||||
|
const serial_port_windows* spw = (serial_port_windows*)sp;
|
||||||
|
if (!GetCommState(spw->hPort, (serial_port)&spw->dcb)) {
|
||||||
|
return spw->dcb.BaudRate;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
Loading…
Add table
Add a link
Reference in a new issue