92 lines
1.7 KiB
C
92 lines
1.7 KiB
C
#include <avr/io.h> // this contains all the IO port definitions
|
|
#include <avr/interrupt.h> // definitions for interrupts
|
|
#include "main.h"
|
|
#include "util.h"
|
|
|
|
#define TXPORT PORTB
|
|
#define TX 1
|
|
|
|
#if (DEBUG == 1)
|
|
|
|
#define SERIALDELAY 75 // to make 19200 baud
|
|
void serialdelay(void) {
|
|
uint16_t timer;
|
|
for (timer=0; timer <= SERIALDELAY; timer++) {
|
|
NOP;
|
|
}
|
|
}
|
|
|
|
|
|
void uart_putchar(char d) {
|
|
int i;
|
|
cli(); // turn off interrupts, make it nice & kleen
|
|
|
|
TXPORT &= ~_BV(TX);
|
|
serialdelay();
|
|
for (i=0; i< 8; i++) {
|
|
if (d & 0x1) {
|
|
TXPORT |= _BV(TX);
|
|
} else {
|
|
TXPORT &= ~_BV(TX);
|
|
}
|
|
serialdelay();
|
|
d >>= 1;
|
|
}
|
|
TXPORT |= _BV(TX);
|
|
sei(); // turn on interrupts
|
|
serialdelay();
|
|
}
|
|
|
|
void printhex(uint8_t hex) {
|
|
hex &= 0xF;
|
|
if (hex < 10)
|
|
uart_putchar(hex + '0');
|
|
else
|
|
uart_putchar(hex + 'A' - 10);
|
|
}
|
|
|
|
void putnum_uh(uint16_t n) {
|
|
if (n >> 12)
|
|
printhex(n>>12);
|
|
if (n >> 8)
|
|
printhex(n >> 8);
|
|
if (n >> 4)
|
|
printhex(n >> 4);
|
|
printhex(n);
|
|
|
|
return;
|
|
}
|
|
|
|
|
|
void putnum_ud(uint16_t n) {
|
|
uint8_t cnt=0, flag=0;
|
|
|
|
while (n >= 10000UL) { flag = 1; cnt++; n -= 10000UL; }
|
|
if (flag) uart_putchar('0'+cnt);
|
|
cnt = 0;
|
|
while (n >= 1000UL) { flag = 1; cnt++; n -= 1000UL; }
|
|
if (flag) uart_putchar('0'+cnt);
|
|
cnt = 0;
|
|
while (n >= 100UL) { flag = 1; cnt++; n -= 100UL; }
|
|
if (flag) uart_putchar('0'+cnt);
|
|
cnt = 0;
|
|
while (n >= 10UL) { flag = 1; cnt++; n -= 10UL; }
|
|
if (flag) uart_putchar('0'+cnt);
|
|
cnt = 0;
|
|
uart_putchar('0'+n);
|
|
return;
|
|
}
|
|
|
|
void ROM_putstring(const char *str, uint8_t nl) {
|
|
uint8_t i;
|
|
|
|
for (i=0; pgm_read_byte(&str[i]); i++) {
|
|
uart_putchar(pgm_read_byte(&str[i]));
|
|
}
|
|
if (nl) {
|
|
uart_putchar('\n'); uart_putchar('\r');
|
|
}
|
|
}
|
|
|
|
#endif
|