1
0
Fork 0
mirror of https://github.com/RobotechLille/cdf2018-principal synced 2024-11-05 08:06:05 +01:00
cdf2018-principal/arduino/serial.c

75 lines
1.6 KiB
C
Raw Normal View History

#include <avr/interrupt.h>
#include <avr/io.h>
#include <FreeRTOS.h>
#include <queue.h>
#include "serial.h"
#include "ACsignals.h"
ISR(USART0_UDRE_vect) {
// When a transmit is ready to be done again
TaskHandle_t holder = xSemaphoreGetMutexHolder(sSendAC);
if (holder != NULL) {
vTaskResume(holder);
}
}
void sendByteAC(unsigned char data) {
while (!bit_is_set(UCSR0A, UDRE0)) {
vTaskSuspend(xSemaphoreGetMutexHolder(sSendAC));
}
UDR0 = data;
}
void sendAC(unsigned char code, void* data, size_t size) {
xSemaphoreTake(sSendAC, 0);
sendByteAC(code);
unsigned char* p = data;
for (int i = 0; i < size; i++) {
sendByteAC(*p++);
}
xSemaphoreGive(sSendAC);
}
ISR(USART0_RX_vect) {
// When a character is received
vTaskResume(tReaderAC);
}
unsigned char readAC() {
while (!bit_is_set(UCSR0A, RXC0)) {
vTaskSuspend(tReaderAC);
}
return UDR0;
}
void TaskReaderAC(void *pvParameters) {
(void) pvParameters;
unsigned char code;
for (;;) {
code = readAC();
char* sending = "Bonjour ! Comment va ?";
sendAC('@', sending, 22);
}
}
void configureAC() {
/* Set baud rate */
UBRR0 = AC_PRESCALER;
/* Set off UART baud doubler */
UCSR0A &= ~(1 << U2X0);
/* Enable transmitter & receiver with interrupts */
UCSR0B = (1 << RXCIE0 | 1 << UDRIE0 | 1 << TXEN0 | 1 << RXEN0);
/* Set 8 bits character and 1 stop bit */
UCSR0C = (1 << UCSZ01 | 1 << UCSZ00);
sSendAC = xSemaphoreCreateMutex();
xTaskCreate(TaskReaderAC, "TaskReaderAC", 128, NULL, 2, &tReaderAC);
}