mirror of
https://github.com/halleysfifthinc/Toyota-AVC-LAN
synced 2025-06-07 07:56:21 +00:00
131 lines
3.5 KiB
C
131 lines
3.5 KiB
C
/*
|
|
AVCLAN-Mockingboard
|
|
Copyright (C) 2015 Allen Hill <allenofthehills@gmail.com>
|
|
|
|
Portions of the following source code are based on code that is
|
|
copyright (C) 2006 Marcin Slonicki <marcin@softservice.com.pl>
|
|
copyright (C) 2007 Louis Frigon
|
|
|
|
This program is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with this program. If not, see <https://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#define USART_BAUD_RATE(BAUD_RATE) \
|
|
(uint16_t)((float)(F_CPU * 64 / (16 * (float)BAUD_RATE)) + 0.5)
|
|
|
|
#include <avr/interrupt.h>
|
|
#include <avr/io.h>
|
|
#include <avr/sfr_defs.h>
|
|
#include <stdint.h>
|
|
|
|
#include "com232.h"
|
|
#include "timing.h"
|
|
|
|
uint8_t RS232_RxCharBuffer[25], RS232_RxCharBegin, RS232_RxCharEnd;
|
|
uint8_t readkey;
|
|
|
|
void RS232_Init(void) {
|
|
RS232_RxCharBegin = RS232_RxCharEnd = 0;
|
|
|
|
PORTMUX.CTRLB = PORTMUX_USART0_ALTERNATE_gc; // Use PA1/PA2 for TxD/RxD
|
|
|
|
PORTA.DIRSET = PIN1_bm;
|
|
PORTA.DIRCLR = PIN2_bm;
|
|
|
|
USART0.CTRLA = USART_RXCIE_bm; // Enable receive interrupts
|
|
USART0.CTRLB = USART_RXEN_bm | USART_TXEN_bm | // Enable Rx/Tx and set receive
|
|
USART_RXMODE_NORMAL_gc; // mode normal
|
|
USART0.CTRLC = USART_CMODE_ASYNCHRONOUS_gc | USART_PMODE_DISABLED_gc |
|
|
USART_CHSIZE_8BIT_gc |
|
|
USART_SBMODE_1BIT_gc; // Async UART with 8N1 config
|
|
USART0.BAUD = USART_BAUD_RATE(250000);
|
|
}
|
|
|
|
ISR(USART0_RXC_vect) {
|
|
// Store received character to the End of Buffer
|
|
RS232_RxCharBuffer[RS232_RxCharEnd] = USART0_RXDATAL;
|
|
RS232_RxCharEnd++;
|
|
}
|
|
|
|
void RS232_SendByte(uint8_t Data) {
|
|
loop_until_bit_is_set(USART0_STATUS,
|
|
USART_DREIF_bp); // wait for UART to become available
|
|
USART0_TXDATAL = Data; // send character
|
|
}
|
|
|
|
void RS232_Print(const char *pBuf) {
|
|
register uint8_t c;
|
|
while ((c = *pBuf++)) {
|
|
if (c == '\n')
|
|
RS232_SendByte('\r');
|
|
RS232_SendByte(c);
|
|
}
|
|
}
|
|
|
|
void RS232_PrintHex4(uint8_t Data) {
|
|
uint8_t Character = Data & 0x0f;
|
|
Character += '0';
|
|
if (Character > '9')
|
|
Character += 'A' - '0' - 10;
|
|
RS232_SendByte(Character);
|
|
}
|
|
|
|
void RS232_PrintHex8(uint8_t Data) {
|
|
RS232_PrintHex4(Data >> 4);
|
|
RS232_PrintHex4(Data);
|
|
}
|
|
|
|
void RS232_PrintDec(uint8_t Data) {
|
|
if (Data > 99) {
|
|
RS232_SendByte('*');
|
|
return;
|
|
}
|
|
if (Data < 10) {
|
|
RS232_SendByte('0' + Data);
|
|
return;
|
|
}
|
|
uint8_t c;
|
|
unsigned short v, v1;
|
|
v = Data;
|
|
v1 = v / 10;
|
|
c = '0' + (v - v1 * 10);
|
|
RS232_SendByte('0' + v1);
|
|
RS232_SendByte(c);
|
|
}
|
|
|
|
void RS232_PrintDec2(uint8_t Data) {
|
|
if (Data < 10)
|
|
RS232_SendByte('0');
|
|
RS232_PrintDec(Data);
|
|
}
|
|
|
|
char *itoa(int i, char b[]) {
|
|
char const digit[] = "0123456789";
|
|
char *p = b;
|
|
if (i < 0) {
|
|
*p++ = '-';
|
|
i *= -1;
|
|
}
|
|
int shifter = i;
|
|
do { // Move to where representation ends
|
|
++p;
|
|
shifter = shifter / 10;
|
|
} while (shifter);
|
|
*p = '\0';
|
|
do { // Move back, inserting digits as u go
|
|
*--p = digit[i % 10];
|
|
i = i / 10;
|
|
} while (i);
|
|
return b;
|
|
}
|