167 lines
3.1 KiB
C
167 lines
3.1 KiB
C
#include "libsss7.h"
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
#include <fcntl.h>
|
|
#include <errno.h>
|
|
#include <termios.h>
|
|
#include <pthread.h>
|
|
#include <sys/time.h>
|
|
|
|
#include "sss7.h"
|
|
|
|
|
|
uint8_t uart_rx_byte;
|
|
_Atomic uint8_t uart_tx_byte, uart_has_tx_byte, uart_tx_done;
|
|
|
|
pthread_t event_thread;
|
|
pthread_mutex_t state_mutex, rx_buffer_mutex;
|
|
|
|
int serial_fd;
|
|
|
|
int get_milliseconds(void) {
|
|
struct timeval tv;
|
|
gettimeofday(&tv,NULL);
|
|
return tv.tv_sec * 1000 + tv.tv_usec / 1000;
|
|
}
|
|
|
|
|
|
int uart_init(char *serialport) {
|
|
serial_fd = open(serialport, O_RDWR | O_NOCTTY | O_NDELAY);
|
|
if (serial_fd == -1) {
|
|
perror("Error: Unable to open serialport");
|
|
return -1;
|
|
}
|
|
|
|
//Switch to blocking mode
|
|
fcntl(serial_fd, F_SETFL, 0);
|
|
|
|
struct termios options;
|
|
cfsetispeed(&options, B9600);
|
|
cfsetospeed(&options, B9600);
|
|
|
|
// 8N1
|
|
options.c_cflag = (CLOCAL | CREAD);
|
|
options.c_cflag |= CS8;
|
|
|
|
// Raw mode, no features
|
|
options.c_lflag = 0;
|
|
|
|
// No parity checks, no flow control
|
|
options.c_iflag = 0;
|
|
|
|
// No output processing
|
|
options.c_oflag = 0;
|
|
|
|
options.c_cc[VTIME] = 1;
|
|
options.c_cc[VMIN] = 0;
|
|
tcsetattr(serial_fd, TCSAFLUSH, &options);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void *eventloop(void *arg);
|
|
|
|
int libsss7_start(char *serialport) {
|
|
int res = 0;
|
|
|
|
sss7_init();
|
|
res = uart_init(serialport);
|
|
if(res) {
|
|
return -1;
|
|
}
|
|
|
|
uart_has_tx_byte = 0;
|
|
uart_tx_done = 0;
|
|
|
|
pthread_mutex_init(&state_mutex, NULL);
|
|
pthread_mutex_init(&rx_buffer_mutex, NULL);
|
|
|
|
res = pthread_create(&event_thread, NULL, eventloop, NULL);
|
|
if(res) {
|
|
printf("Could not create eventloop thread\n");
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int libsss7_can_send(void) {
|
|
return sss7_can_send();
|
|
}
|
|
|
|
void libsss7_send(uint8_t msg[SSS7_PAYLOAD_SIZE]) {
|
|
pthread_mutex_lock(&state_mutex);
|
|
sss7_send(msg);
|
|
pthread_mutex_unlock(&state_mutex);
|
|
}
|
|
|
|
int libsss7_send_failed(void) {
|
|
return sss7_send_failed();
|
|
}
|
|
|
|
int libsss7_has_received(void) {
|
|
return sss7_has_received();
|
|
}
|
|
|
|
void libsss7_get_received(uint8_t msg[SSS7_PAYLOAD_SIZE]) {
|
|
pthread_mutex_lock(&rx_buffer_mutex);
|
|
sss7_get_received(msg);
|
|
pthread_mutex_unlock(&rx_buffer_mutex);
|
|
}
|
|
|
|
void libsss7_stop() {
|
|
pthread_join(event_thread, NULL);
|
|
|
|
close(serial_fd);
|
|
}
|
|
|
|
uint8_t uart_get_byte(void) {
|
|
return uart_rx_byte;
|
|
}
|
|
|
|
void uart_put_byte(uint8_t byte) {
|
|
uart_has_tx_byte = 1;
|
|
uart_tx_byte = byte;
|
|
}
|
|
|
|
void *eventloop(void *arg) {
|
|
int res = 0;
|
|
int timestamp = get_milliseconds();
|
|
while(1) {
|
|
printf("Loop\n");
|
|
if(uart_has_tx_byte) {
|
|
write(serial_fd, &uart_tx_byte, 1);
|
|
printf("Send %x\n", uart_tx_byte);
|
|
uart_has_tx_byte = 0;
|
|
uart_tx_done = 1;
|
|
}
|
|
|
|
res = read(serial_fd, &uart_rx_byte, 1);
|
|
if(res == 1) {
|
|
pthread_mutex_lock(&state_mutex);
|
|
pthread_mutex_lock(&rx_buffer_mutex);
|
|
sss7_process_rx();
|
|
pthread_mutex_unlock(&rx_buffer_mutex);
|
|
pthread_mutex_unlock(&state_mutex);
|
|
}
|
|
|
|
if(uart_tx_done) {
|
|
uart_tx_done = 0;
|
|
pthread_mutex_lock(&state_mutex);
|
|
sss7_process_tx();
|
|
pthread_mutex_unlock(&state_mutex);
|
|
}
|
|
|
|
pthread_mutex_lock(&state_mutex);
|
|
int now = get_milliseconds();
|
|
printf("Ticks: %d\n", now - timestamp);
|
|
sss7_process_ticks(now - timestamp);
|
|
timestamp = now;
|
|
pthread_mutex_unlock(&state_mutex);
|
|
}
|
|
|
|
return NULL;
|
|
}
|