failed approach
This commit is contained in:
230
gomspace/libgscsp/lib/libcsp/src/drivers/usart/usart_windows.c
Normal file
230
gomspace/libgscsp/lib/libcsp/src/drivers/usart/usart_windows.c
Normal file
@ -0,0 +1,230 @@
|
||||
#include <stdio.h>
|
||||
#include <Windows.h>
|
||||
#include <process.h>
|
||||
|
||||
#include <csp/csp.h>
|
||||
#include <csp/drivers/usart.h>
|
||||
|
||||
static HANDLE portHandle = INVALID_HANDLE_VALUE;
|
||||
static HANDLE rxThread = INVALID_HANDLE_VALUE;
|
||||
static CRITICAL_SECTION txSection;
|
||||
static LONG isListening = 0;
|
||||
static usart_callback_t usart_callback = NULL;
|
||||
|
||||
static void prvSendData(char *buf, int bufsz);
|
||||
static int prvTryOpenPort(const char* intf);
|
||||
static int prvTryConfigurePort(const struct usart_conf*);
|
||||
static int prvTrySetPortTimeouts(void);
|
||||
static const char* prvParityToStr(BYTE paritySetting);
|
||||
|
||||
#ifdef CSP_DEBUG
|
||||
static void prvPrintError(void) {
|
||||
char *messageBuffer = NULL;
|
||||
DWORD errorCode = GetLastError();
|
||||
DWORD formatMessageRet;
|
||||
formatMessageRet = FormatMessageA(
|
||||
FORMAT_MESSAGE_ALLOCATE_BUFFER |
|
||||
FORMAT_MESSAGE_FROM_SYSTEM,
|
||||
NULL,
|
||||
errorCode,
|
||||
MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT),
|
||||
(char*)&messageBuffer,
|
||||
0,
|
||||
NULL);
|
||||
|
||||
if( !formatMessageRet ) {
|
||||
csp_log_error("FormatMessage error, code: %lu", GetLastError());
|
||||
return;
|
||||
}
|
||||
csp_log_error("%s", messageBuffer);
|
||||
LocalFree(messageBuffer);
|
||||
}
|
||||
#endif
|
||||
|
||||
#ifdef CSP_DEBUG
|
||||
#define printError() prvPrintError()
|
||||
#else
|
||||
#define printError() do {} while(0)
|
||||
#endif
|
||||
|
||||
static int prvTryOpenPort(const char *intf) {
|
||||
portHandle = CreateFileA(
|
||||
intf,
|
||||
GENERIC_READ|GENERIC_WRITE,
|
||||
0,
|
||||
NULL,
|
||||
OPEN_EXISTING,
|
||||
0,
|
||||
NULL);
|
||||
|
||||
if( portHandle == INVALID_HANDLE_VALUE ) {
|
||||
DWORD errorCode = GetLastError();
|
||||
if( errorCode == ERROR_FILE_NOT_FOUND ) {
|
||||
csp_log_error("Could not open serial port, because it didn't exist!");
|
||||
}
|
||||
else
|
||||
csp_log_error("Failure opening serial port! Code: %lu", errorCode);
|
||||
return 1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int prvTryConfigurePort(const struct usart_conf * conf) {
|
||||
DCB portSettings = {0};
|
||||
portSettings.DCBlength = sizeof(DCB);
|
||||
if(!GetCommState(portHandle, &portSettings) ) {
|
||||
csp_log_error("Could not get default settings for open COM port! Code: %lu", GetLastError());
|
||||
return -1;
|
||||
}
|
||||
portSettings.BaudRate = conf->baudrate;
|
||||
portSettings.Parity = conf->paritysetting;
|
||||
portSettings.StopBits = conf->stopbits;
|
||||
portSettings.fParity = conf->checkparity;
|
||||
portSettings.fBinary = TRUE;
|
||||
portSettings.ByteSize = conf->databits;
|
||||
if( !SetCommState(portHandle, &portSettings) ) {
|
||||
csp_log_error("Error when setting COM port settings! Code:%lu", GetLastError());
|
||||
return 1;
|
||||
}
|
||||
|
||||
GetCommState(portHandle, &portSettings);
|
||||
|
||||
csp_log_info("Port: %s, Baudrate: %lu, Data bits: %d, Stop bits: %d, Parity: %s",
|
||||
conf->device, conf->baudrate, conf->databits, conf->stopbits, prvParityToStr(conf->paritysetting));
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const char* prvParityToStr(BYTE paritySetting) {
|
||||
static const char *parityStr[] = {
|
||||
"None",
|
||||
"Odd",
|
||||
"Even",
|
||||
"N/A"
|
||||
};
|
||||
char const *resultStr = NULL;
|
||||
|
||||
switch(paritySetting) {
|
||||
case NOPARITY:
|
||||
resultStr = parityStr[0];
|
||||
break;
|
||||
case ODDPARITY:
|
||||
resultStr = parityStr[1];
|
||||
break;
|
||||
case EVENPARITY:
|
||||
resultStr = parityStr[2];
|
||||
break;
|
||||
default:
|
||||
resultStr = parityStr[3];
|
||||
};
|
||||
return resultStr;
|
||||
}
|
||||
|
||||
static int prvTrySetPortTimeouts(void) {
|
||||
COMMTIMEOUTS timeouts = {0};
|
||||
|
||||
if( !GetCommTimeouts(portHandle, &timeouts) ) {
|
||||
csp_log_error("Error gettings current timeout settings");
|
||||
return 1;
|
||||
}
|
||||
|
||||
timeouts.ReadIntervalTimeout = 5;
|
||||
timeouts.ReadTotalTimeoutMultiplier = 1;
|
||||
timeouts.ReadTotalTimeoutConstant = 5;
|
||||
timeouts.WriteTotalTimeoutMultiplier = 1;
|
||||
timeouts.WriteTotalTimeoutConstant = 5;
|
||||
|
||||
if(!SetCommTimeouts(portHandle, &timeouts)) {
|
||||
csp_log_error("Error setting timeouts!");
|
||||
return 1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
unsigned WINAPI prvRxTask(void* params) {
|
||||
DWORD bytesRead;
|
||||
DWORD eventStatus;
|
||||
uint8_t recvBuffer[24];
|
||||
SetCommMask(portHandle, EV_RXCHAR);
|
||||
|
||||
while(isListening) {
|
||||
WaitCommEvent(portHandle, &eventStatus, NULL);
|
||||
if( !(eventStatus & EV_RXCHAR) ) {
|
||||
continue;
|
||||
}
|
||||
if( !ReadFile(portHandle, recvBuffer, 24, &bytesRead, NULL)) {
|
||||
csp_log_warn("Error receiving data! Code: %lu", GetLastError());
|
||||
continue;
|
||||
}
|
||||
if( usart_callback != NULL )
|
||||
usart_callback(recvBuffer, (size_t)bytesRead, NULL);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void prvSendData(char *buf, int bufsz) {
|
||||
DWORD bytesTotal = 0;
|
||||
DWORD bytesActual;
|
||||
if( !WriteFile(portHandle, buf, bufsz-bytesTotal, &bytesActual, NULL) ) {
|
||||
csp_log_error("Could not write data. Code: %lu", GetLastError());
|
||||
return;
|
||||
}
|
||||
if( !FlushFileBuffers(portHandle) ) {
|
||||
csp_log_warn("Could not flush write buffer. Code: %lu", GetLastError());
|
||||
}
|
||||
}
|
||||
|
||||
void usart_shutdown(void) {
|
||||
InterlockedExchange(&isListening, 0);
|
||||
CloseHandle(portHandle);
|
||||
portHandle = INVALID_HANDLE_VALUE;
|
||||
if( rxThread != INVALID_HANDLE_VALUE ) {
|
||||
WaitForSingleObject(rxThread, INFINITE);
|
||||
rxThread = INVALID_HANDLE_VALUE;
|
||||
}
|
||||
DeleteCriticalSection(&txSection);
|
||||
}
|
||||
|
||||
void usart_listen(void) {
|
||||
InterlockedExchange(&isListening, 1);
|
||||
rxThread = (HANDLE)_beginthreadex(NULL, 0, &prvRxTask, NULL, 0, NULL);
|
||||
}
|
||||
|
||||
void usart_putstr(char* buf, int bufsz) {
|
||||
EnterCriticalSection(&txSection);
|
||||
prvSendData(buf, bufsz);
|
||||
LeaveCriticalSection(&txSection);
|
||||
}
|
||||
|
||||
void usart_insert(char c, void *pxTaskWoken) {
|
||||
/* redirect debug output to stdout */
|
||||
printf("%c", c);
|
||||
}
|
||||
|
||||
void usart_set_callback(usart_callback_t callback) {
|
||||
usart_callback = callback;
|
||||
}
|
||||
|
||||
void usart_init(struct usart_conf * conf) {
|
||||
if( prvTryOpenPort(conf->device) ) {
|
||||
printError();
|
||||
return;
|
||||
}
|
||||
|
||||
if( prvTryConfigurePort(conf) ) {
|
||||
printError();
|
||||
return;
|
||||
}
|
||||
|
||||
if( prvTrySetPortTimeouts() ) {
|
||||
printError();
|
||||
return;
|
||||
}
|
||||
|
||||
InitializeCriticalSection(&txSection);
|
||||
|
||||
/* Start receiver thread */
|
||||
usart_listen();
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user