Moved libraries to lib directory, added hardware abstraction lib
This commit is contained in:
bigalex
parent
9810b13d17
commit
8dc4c5bbc7
|
|
@ -4,12 +4,13 @@
|
||||||
|
|
||||||
#curl http://seb.exse.net/ledtest.hex > ledtest.hex && avrflash.sh m168 -F -v -v -U flash:w:ledtest.hex
|
#curl http://seb.exse.net/ledtest.hex > ledtest.hex && avrflash.sh m168 -F -v -v -U flash:w:ledtest.hex
|
||||||
|
|
||||||
#MCU = atmega88p
|
|
||||||
#MCU = atmega328p
|
#MCU = atmega328p
|
||||||
|
|
||||||
#MCU = atmega644
|
#MCU = atmega644
|
||||||
F_CPU = 8000000
|
MCU = atmega88p
|
||||||
|
|
||||||
#F_CPU = 20000000
|
#F_CPU = 20000000
|
||||||
|
F_CPU = 8000000
|
||||||
|
|
||||||
QUARZ = 8MHZ
|
QUARZ = 8MHZ
|
||||||
|
|
||||||
#internal RC/8
|
#internal RC/8
|
||||||
|
|
@ -35,7 +36,7 @@ OPT = s
|
||||||
|
|
||||||
##########################################################################################################
|
##########################################################################################################
|
||||||
# List C source files here. (C dependencies are automatically generated.)
|
# List C source files here. (C dependencies are automatically generated.)
|
||||||
SRC = main.c lib/synth.c lib/usart.c
|
SRC = main.c lib/synth.c lib/usart.c lib/bughal.c
|
||||||
##########################################################################################################
|
##########################################################################################################
|
||||||
|
|
||||||
|
|
||||||
|
|
|
||||||
39
firmware/lib/bughal.c
Normal file
39
firmware/lib/bughal.c
Normal file
|
|
@ -0,0 +1,39 @@
|
||||||
|
#include <inttypes.h>
|
||||||
|
#include "bughal.h"
|
||||||
|
|
||||||
|
/* Hardware abstraction layer for Pentabug hardware */
|
||||||
|
|
||||||
|
/*
|
||||||
|
* initialize LEDs on C0-C3
|
||||||
|
*/
|
||||||
|
void init_leds(void){
|
||||||
|
//enable LED channels as output
|
||||||
|
DDRC |= (1 << PORTC0) | (1 << PORTC1) | (1 << PORTC2) | (1 << PORTC3);
|
||||||
|
// both LEDs off
|
||||||
|
PORTC &= ~(1 << PORTC0) | (1 << PORTC1) | (1 << PORTC2) | (1 << PORTC3);
|
||||||
|
|
||||||
|
|
||||||
|
//TCCR2A = (1 << WGM21);
|
||||||
|
//TCCR2B = (1 << CS20)|(1 << CS21);
|
||||||
|
//OCR2A = 255; /* TOP */
|
||||||
|
// TCNT2 = 0;
|
||||||
|
// /*enable interrupt*/
|
||||||
|
// TIMSK2 |= (1<<OCIE2A);
|
||||||
|
|
||||||
|
|
||||||
|
return;
|
||||||
|
};
|
||||||
|
|
||||||
|
void init_buzzr(int mode);
|
||||||
|
|
||||||
|
|
||||||
|
void init_switch();
|
||||||
|
|
||||||
|
static void init_motor(void)
|
||||||
|
{
|
||||||
|
/* vibration motor on B1, initially off: */
|
||||||
|
DDRB |= (1 << PORTB1);
|
||||||
|
PORTB &= ~( 1<<PORTB1);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
17
firmware/lib/bughal.h
Normal file
17
firmware/lib/bughal.h
Normal file
|
|
@ -0,0 +1,17 @@
|
||||||
|
#ifndef BUGHAL_H
|
||||||
|
#define BUGHAL_H
|
||||||
|
|
||||||
|
/* Hardware abstraction layer for Pentabug hardware */
|
||||||
|
|
||||||
|
enum { BUZZR_OUT, //initialize buzzer for OUTPUT mode (emmiting soundwaves)
|
||||||
|
BUZZR_IN //initialize buzzer for INPUT mode (registering soundwaves)
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
void init_leds(void);
|
||||||
|
void init_buzzr(int);
|
||||||
|
void init_switch(void);
|
||||||
|
void init_motor(void);
|
||||||
|
|
||||||
|
#endif
|
||||||
324
firmware/lib/synth.c
Normal file
324
firmware/lib/synth.c
Normal file
|
|
@ -0,0 +1,324 @@
|
||||||
|
#include <inttypes.h>
|
||||||
|
#include "synth.h"
|
||||||
|
#include "freq_table.h"
|
||||||
|
#include <avr/pgmspace.h>
|
||||||
|
#include <avr/interrupt.h>
|
||||||
|
|
||||||
|
// sample rate is 8M / (3 * 64)
|
||||||
|
|
||||||
|
enum {
|
||||||
|
channel_count = 3,
|
||||||
|
//tick_length = 400,
|
||||||
|
// tick_length = 256,
|
||||||
|
row_length = 4,
|
||||||
|
pattern_length = 16
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
static const synth_instrument_t instruments[] = {
|
||||||
|
{ 1<<15, 100, 12 },
|
||||||
|
{ 0, 100, 12 },
|
||||||
|
{ 0, 200, 10 },
|
||||||
|
{ 1<<13, 0, 0, 2 },
|
||||||
|
{ 1<<13, 0, 5, 2 },
|
||||||
|
};
|
||||||
|
|
||||||
|
static const uint8_t wave_table[][2] = {
|
||||||
|
{ 0, WAVE_PULSE },
|
||||||
|
{ 3, WAVE_PULSE },
|
||||||
|
{ 7, WAVE_PULSE },
|
||||||
|
{ 12, WAVE_PULSE },
|
||||||
|
{ 256 - 4, 0xff },
|
||||||
|
|
||||||
|
{ 0, WAVE_PULSE },
|
||||||
|
{ 2, WAVE_PULSE },
|
||||||
|
{ 7, WAVE_PULSE },
|
||||||
|
{ 10, WAVE_PULSE },
|
||||||
|
{ 256 - 4, 0xff },
|
||||||
|
|
||||||
|
{ 0, WAVE_NOISE },
|
||||||
|
{ 0, WAVE_PULSE },
|
||||||
|
{ 0xff, 0xff },
|
||||||
|
|
||||||
|
{ 0, WAVE_PULSE },
|
||||||
|
{ 0xff, 0xff },
|
||||||
|
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
static const uint8_t patterns[][pattern_length][2] PROGMEM = {
|
||||||
|
{},
|
||||||
|
{
|
||||||
|
{ 33 - 12, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 33, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 33, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 33, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 33 - 12, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 33 - 12, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 33, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
},
|
||||||
|
{
|
||||||
|
{ 28 - 12, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 28, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 28, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 28, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 28 - 12, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 28 - 12, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
{ 28, 1 },
|
||||||
|
{ 0xff, 1 },
|
||||||
|
},
|
||||||
|
{
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 57, 3 },
|
||||||
|
},
|
||||||
|
{
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 57, 4 },
|
||||||
|
},
|
||||||
|
|
||||||
|
|
||||||
|
{
|
||||||
|
{ 60, 2 },
|
||||||
|
},
|
||||||
|
{
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 57, 2 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 55, 2 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 57, 2 },
|
||||||
|
{ 0, 0 },
|
||||||
|
},
|
||||||
|
{
|
||||||
|
{ 55, 2 },
|
||||||
|
},
|
||||||
|
{
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 0, 0 },
|
||||||
|
{ 57, 2 },
|
||||||
|
},
|
||||||
|
{
|
||||||
|
{ 55-3, 2 },
|
||||||
|
},
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
};
|
||||||
|
|
||||||
|
static const uint8_t pattern_table[][channel_count] = {
|
||||||
|
{ 1, 0, 5 },
|
||||||
|
{ 1, 3, 0 },
|
||||||
|
{ 1, 0, 7 },
|
||||||
|
{ 1, 3, 6 },
|
||||||
|
{ 2, 0, 7 },
|
||||||
|
{ 2, 4, 8 },
|
||||||
|
{ 2, 0, 9 },
|
||||||
|
{ 2, 4, 0 },
|
||||||
|
};
|
||||||
|
enum {
|
||||||
|
pattern_table_length = sizeof(pattern_table) / sizeof(pattern_table[0])
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
static synth_channel_t channels[channel_count];
|
||||||
|
static int8_t sample;
|
||||||
|
static int8_t tick;
|
||||||
|
static int8_t row;
|
||||||
|
static int8_t seq;
|
||||||
|
|
||||||
|
|
||||||
|
/* PROTOTYPES */
|
||||||
|
uint8_t synth_mix(void);
|
||||||
|
|
||||||
|
static uint8_t timeslots[SYNTH_BUFSIZE];
|
||||||
|
static uint8_t timeslots_write; // current write head
|
||||||
|
static uint8_t timeslots_read; // current read head
|
||||||
|
|
||||||
|
/*register for atomic ++ and -- */
|
||||||
|
register uint8_t timeslots_fill asm("r2");
|
||||||
|
|
||||||
|
|
||||||
|
static void enqueue_timeslot(uint8_t synthval);
|
||||||
|
static uint8_t dequeue_timeslot(void);
|
||||||
|
|
||||||
|
void synth_init(void)
|
||||||
|
{
|
||||||
|
sample = 0;
|
||||||
|
tick = 0;
|
||||||
|
row = 0;
|
||||||
|
seq = 0;
|
||||||
|
timeslots_fill = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
inline uint8_t synth_mix(void)
|
||||||
|
{
|
||||||
|
if(sample == 0) { // new tick
|
||||||
|
for(int i = 1; i < channel_count; i++) {
|
||||||
|
synth_channel_t* chan = &channels[i];
|
||||||
|
|
||||||
|
const synth_instrument_t* inst = &instruments[chan->inst_nr];
|
||||||
|
|
||||||
|
if(chan->level > inst->decay) chan->level -= inst->decay;
|
||||||
|
else chan->level = 0;
|
||||||
|
|
||||||
|
chan->pulse_width += inst->pulse_sweep;
|
||||||
|
|
||||||
|
chan->pos++;
|
||||||
|
if(wave_table[chan->pos][1] == 0xff) chan->pos += wave_table[chan->pos][0];
|
||||||
|
|
||||||
|
|
||||||
|
// enter new rol
|
||||||
|
// w
|
||||||
|
if(tick == 0) {
|
||||||
|
uint8_t pattern_nr = pattern_table[seq][i];
|
||||||
|
uint8_t note = pgm_read_byte(&patterns[pattern_nr][row][0]);
|
||||||
|
|
||||||
|
if(note) { // new note, maybe?
|
||||||
|
if(note == 0xff) {
|
||||||
|
chan->level = 0;
|
||||||
|
} else {
|
||||||
|
chan->level = 80; // TODO: less?
|
||||||
|
chan->note = note;
|
||||||
|
chan->inst_nr = pgm_read_byte(&patterns[pattern_nr][row][1]);
|
||||||
|
inst = &instruments[chan->inst_nr];
|
||||||
|
chan->pos = inst->wave_table_pos;
|
||||||
|
if(inst->pulse_width) chan->pulse_width = inst->pulse_width;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if(++sample == 0){
|
||||||
|
if(++tick == row_length) {
|
||||||
|
tick = 0;
|
||||||
|
if(++row == pattern_length) {
|
||||||
|
row = 0;
|
||||||
|
if(++seq == pattern_table_length) {
|
||||||
|
seq = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint8_t output = 0;
|
||||||
|
for(int i = 0; i < channel_count; i++) {
|
||||||
|
synth_channel_t* chan = &channels[i];
|
||||||
|
// const synth_instrument_t* inst = &instruments[chan->inst_nr];
|
||||||
|
|
||||||
|
chan->phase += pgm_read_word(&freq_table[(uint8_t)(chan->note + wave_table[chan->pos][0])]);
|
||||||
|
|
||||||
|
uint8_t amp;
|
||||||
|
switch(wave_table[chan->pos][1]) {
|
||||||
|
case WAVE_PULSE:
|
||||||
|
amp = -(chan->phase < chan->pulse_width);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case WAVE_SAW:
|
||||||
|
amp = (chan->phase >> 8);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case WAVE_NOISE: // shitty noise
|
||||||
|
chan->phase = (chan->phase >> 1) ^ (-(chan->phase & 1) & 0xb400);
|
||||||
|
amp = (chan->phase >> 8);
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
amp = 0;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
output += (((amp & 0xff) * chan->level) >> 8);
|
||||||
|
}
|
||||||
|
|
||||||
|
return output;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/* fill all the timeslots */
|
||||||
|
inline void synth_poll(void) {
|
||||||
|
/* refill timeslots queue */
|
||||||
|
// while (timeslots_fill < (SYNTH_BUFSIZE-1))
|
||||||
|
if (timeslots_fill < (SYNTH_BUFSIZE-1))
|
||||||
|
enqueue_timeslot(synth_mix());
|
||||||
|
}
|
||||||
|
|
||||||
|
/* timeslot queue handling */
|
||||||
|
static inline void enqueue_timeslot(uint8_t synthval) {
|
||||||
|
timeslots[timeslots_write & SYNTH_BUFMASK] = synthval;
|
||||||
|
timeslots_fill++;
|
||||||
|
timeslots_write++;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline uint8_t dequeue_timeslot() {
|
||||||
|
uint8_t t = timeslots[timeslots_read & SYNTH_BUFMASK];
|
||||||
|
if(timeslots_fill){
|
||||||
|
/* buffer not underrun... move forward in readbuffer */
|
||||||
|
|
||||||
|
timeslots_fill --;
|
||||||
|
timeslots_read ++;
|
||||||
|
}
|
||||||
|
|
||||||
|
return t;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
ISR(TIMER0_COMPA_vect)
|
||||||
|
{
|
||||||
|
/* calculate next analog sample value in synth mixer:*/
|
||||||
|
OCR1B = dequeue_timeslot();
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
34
firmware/lib/synth.h
Normal file
34
firmware/lib/synth.h
Normal file
|
|
@ -0,0 +1,34 @@
|
||||||
|
#ifndef SYNTH_H
|
||||||
|
#define SYNTH_H
|
||||||
|
|
||||||
|
#define SYNTH_BUFSIZE (16)
|
||||||
|
#define SYNTH_BUFMASK (0b00001111)
|
||||||
|
|
||||||
|
enum { WAVE_OFF, WAVE_PULSE, WAVE_SAW, WAVE_NOISE };
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
uint8_t note;
|
||||||
|
uint8_t inst_nr;
|
||||||
|
uint8_t pos;
|
||||||
|
|
||||||
|
uint16_t phase;
|
||||||
|
uint16_t pulse_width;
|
||||||
|
|
||||||
|
uint8_t level; // envelop level
|
||||||
|
|
||||||
|
} synth_channel_t;
|
||||||
|
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
uint16_t pulse_width;
|
||||||
|
uint8_t pulse_sweep;
|
||||||
|
uint8_t wave_table_pos;
|
||||||
|
uint8_t decay;
|
||||||
|
|
||||||
|
} synth_instrument_t;
|
||||||
|
|
||||||
|
|
||||||
|
void synth_init(void);
|
||||||
|
void synth_poll(void);
|
||||||
|
|
||||||
|
#endif
|
||||||
136
firmware/lib/usart.c
Normal file
136
firmware/lib/usart.c
Normal file
|
|
@ -0,0 +1,136 @@
|
||||||
|
/*
|
||||||
|
* PentaFnord Firmware
|
||||||
|
*
|
||||||
|
* by Alexander Lorz <bigalex@gmx.de>
|
||||||
|
*
|
||||||
|
*
|
||||||
|
* The USART control code is derived by code from the 4CHLED project
|
||||||
|
* by sebseb7: https://github.com/sebseb7/eagle/tree/master/4CHLED/firmware
|
||||||
|
*
|
||||||
|
* This program is free software: you can redistribute it and/or modify it
|
||||||
|
* under the terms of the GNU General Public License version 3 as published by
|
||||||
|
* the Free Software Foundation.
|
||||||
|
*
|
||||||
|
* 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 <http://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <avr/io.h>
|
||||||
|
#include <avr/interrupt.h>
|
||||||
|
|
||||||
|
//#include "main.h"
|
||||||
|
#include "usart.h"
|
||||||
|
|
||||||
|
#define UART_RXBUFSIZE 32
|
||||||
|
|
||||||
|
volatile static uint8_t rxbuf0[UART_RXBUFSIZE];
|
||||||
|
volatile static uint8_t *volatile rxhead0, *volatile rxtail0;
|
||||||
|
//volatile uint8_t xon = 0;
|
||||||
|
|
||||||
|
|
||||||
|
ISR (USART_RX_vect)
|
||||||
|
{
|
||||||
|
UCSR0B &= ~(1 << RXCIE0);
|
||||||
|
asm volatile("sei");
|
||||||
|
|
||||||
|
int diff;
|
||||||
|
uint8_t c;
|
||||||
|
c=UDR0;
|
||||||
|
diff = rxhead0 - rxtail0;
|
||||||
|
if (diff < 0) diff += UART_RXBUFSIZE;
|
||||||
|
if (diff < UART_RXBUFSIZE -1)
|
||||||
|
{
|
||||||
|
*rxhead0 = c;
|
||||||
|
++rxhead0;
|
||||||
|
if (rxhead0 == (rxbuf0 + UART_RXBUFSIZE)) rxhead0 = rxbuf0;
|
||||||
|
// if((diff > 100)&&(xon==0))
|
||||||
|
// {
|
||||||
|
// xon=1;
|
||||||
|
// //set the CTS pin
|
||||||
|
// }
|
||||||
|
}
|
||||||
|
UCSR0B |= (1 << RXCIE0);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void USART0_Init (void)
|
||||||
|
{
|
||||||
|
// set baudrate
|
||||||
|
#undef BAUD
|
||||||
|
#define BAUD 115200
|
||||||
|
#include <util/setbaud.h><util/setbaud.h>
|
||||||
|
UBRR0H = UBRRH_VALUE;
|
||||||
|
UBRR0L = UBRRL_VALUE;
|
||||||
|
|
||||||
|
//#if USE_2X
|
||||||
|
UCSR0A |= (1 << U2X0); // enable double speed operation
|
||||||
|
//#else
|
||||||
|
// UCSR0A &= ~(1 << U2X0); // disable double speed operation
|
||||||
|
//#endif
|
||||||
|
|
||||||
|
|
||||||
|
// flush receive buffer
|
||||||
|
while ( UCSR0A & (1 << RXC0) ) UDR0;
|
||||||
|
|
||||||
|
// set 8N1
|
||||||
|
UCSR0C = (1 << UCSZ01) | (1 << UCSZ00);
|
||||||
|
UCSR0B &= ~(1 << UCSZ02);
|
||||||
|
|
||||||
|
UCSR0B |= (1 << RXEN0)|(1 << TXEN0); //enable send and receive
|
||||||
|
|
||||||
|
UCSR0B |= (1 << RXCIE0); //enable receive interrup
|
||||||
|
|
||||||
|
rxhead0 = rxtail0 = rxbuf0;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
void USART0_putc (char c)
|
||||||
|
{
|
||||||
|
|
||||||
|
loop_until_bit_is_set(UCSR0A, UDRE0);
|
||||||
|
UDR0 = c;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint8_t USART0_Getc_nb(uint8_t *c)
|
||||||
|
{
|
||||||
|
if (rxhead0==rxtail0) return 0;
|
||||||
|
*c = *rxtail0;
|
||||||
|
if (++rxtail0 == (rxbuf0 + UART_RXBUFSIZE)) rxtail0 = rxbuf0;
|
||||||
|
|
||||||
|
// uint8_t diff = rxhead0 - rxtail0;
|
||||||
|
// if((diff < 10)&&(xon==1))
|
||||||
|
// {
|
||||||
|
// xon=0;
|
||||||
|
// //set the CTS pin
|
||||||
|
// }
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
void USART0_crlf(){
|
||||||
|
USART0_putc(0x0A); //newline
|
||||||
|
USART0_putc(0x0D); //carriage return
|
||||||
|
};
|
||||||
|
|
||||||
|
void USART0_put_uint8(uint8_t x){
|
||||||
|
uint8_t highchar=((x & 0b11110000)>>4)+0x30;
|
||||||
|
uint8_t lowchar = (x & 0b00001111)+0x30;
|
||||||
|
highchar = highchar>0x39 ? highchar + 0x07 : highchar; //chars A to F start with 0x41 not 0x3A
|
||||||
|
lowchar = lowchar>0x39 ? lowchar + 0x07 : lowchar;
|
||||||
|
USART0_putc(highchar);
|
||||||
|
USART0_putc(lowchar);
|
||||||
|
|
||||||
|
}
|
||||||
|
void USART0_put_uint16(uint16_t x){
|
||||||
|
USART0_put_uint8 ((x & 0xFF00)>>8);
|
||||||
|
USART0_put_uint8 (x & 0x00FF);
|
||||||
|
|
||||||
|
}
|
||||||
34
firmware/lib/usart.h
Normal file
34
firmware/lib/usart.h
Normal file
|
|
@ -0,0 +1,34 @@
|
||||||
|
/*
|
||||||
|
* PentaFnord Firmware
|
||||||
|
*
|
||||||
|
* by Alexander Lorz <bigalex@gmx.de>
|
||||||
|
*
|
||||||
|
*
|
||||||
|
* The USART control code is derived by code from the 4CHLED project
|
||||||
|
* by sebseb7: https://github.com/sebseb7/eagle/tree/master/4CHLED/firmware
|
||||||
|
*
|
||||||
|
* This program is free software: you can redistribute it and/or modify it
|
||||||
|
* under the terms of the GNU General Public License version 3 as published by
|
||||||
|
* the Free Software Foundation.
|
||||||
|
*
|
||||||
|
* 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 <http://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _USART_H
|
||||||
|
#define _USART_H
|
||||||
|
|
||||||
|
void USART0_Init (void);
|
||||||
|
void USART0_putc (char c);
|
||||||
|
uint8_t USART0_Getc_nb(uint8_t*);
|
||||||
|
void USART0_put_uint8(uint8_t);
|
||||||
|
void USART0_crlf();
|
||||||
|
void USART0_put_uint16(uint16_t);
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
|
|
@ -49,29 +49,6 @@ static inline void init_pwm(void)
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void init_leds(void)
|
|
||||||
{
|
|
||||||
/* enable LED channels as output */
|
|
||||||
DDRC |= (1 << PORTC0) | (1 << PORTC2) |
|
|
||||||
(1 << PORTC3) | (1 << PORTC1) ;
|
|
||||||
/* initially one led is on */
|
|
||||||
PORTC = 0b00000101;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Timer 2
|
|
||||||
*/
|
|
||||||
|
|
||||||
/* set timer2 to CTC & prescaler 64 → ???125kHz increment */
|
|
||||||
TCCR2A = (1 << WGM21);
|
|
||||||
TCCR2B = (1 << CS20)|(1 << CS21);
|
|
||||||
|
|
||||||
OCR2A = 255; /* TOP */
|
|
||||||
TCNT2 = 0;
|
|
||||||
/*enable interrupt*/
|
|
||||||
TIMSK2 |= (1<<OCIE2A);
|
|
||||||
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
inline void setleds(uint8_t state)
|
inline void setleds(uint8_t state)
|
||||||
{
|
{
|
||||||
|
|
@ -81,13 +58,6 @@ inline void setleds(uint8_t state)
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void init_motor(void)
|
|
||||||
{
|
|
||||||
/* vibration motor on B1, initially off: */
|
|
||||||
DDRB |= (1 << PORTB1);
|
|
||||||
PORTB &= ~( 1<<PORTB1);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue
Block a user