new pins system, updated lib files for it
This commit is contained in:
@@ -1,42 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
//
|
|
||||||
// Pin definitions for Arduino (Pro Mini with ATmega328P)
|
|
||||||
//
|
|
||||||
|
|
||||||
#include "pins.h"
|
|
||||||
|
|
||||||
#define D0 D,0
|
|
||||||
#define D1 D,1
|
|
||||||
#define D2 D,2
|
|
||||||
#define D3 D,3
|
|
||||||
#define D4 D,4
|
|
||||||
#define D5 D,5
|
|
||||||
#define D6 D,6
|
|
||||||
#define D7 D,7
|
|
||||||
#define D8 B,0
|
|
||||||
#define D9 B,1
|
|
||||||
#define D10 B,2
|
|
||||||
|
|
||||||
// MOSI MISO SCK - not good for input
|
|
||||||
#define D11 B,3
|
|
||||||
#define D12 B,4
|
|
||||||
#define D13 B,5
|
|
||||||
|
|
||||||
#define D14 C,0
|
|
||||||
#define D15 C,1
|
|
||||||
#define D16 C,2
|
|
||||||
#define D17 C,3
|
|
||||||
#define D18 C,4
|
|
||||||
#define D19 C,5
|
|
||||||
#define D20 C,6
|
|
||||||
#define D21 C,7
|
|
||||||
|
|
||||||
#define A0 C,0
|
|
||||||
#define A1 C,1
|
|
||||||
#define A2 C,2
|
|
||||||
#define A3 C,3
|
|
||||||
#define A4 C,4
|
|
||||||
#define A5 C,5
|
|
||||||
#define A6 C,6
|
|
||||||
#define A7 C,7
|
|
||||||
+12
-16
@@ -30,16 +30,14 @@
|
|||||||
#define cbi(reg, bit) do { (reg) &= ~(1 << (uint8_t)(bit)); } while(0)
|
#define cbi(reg, bit) do { (reg) &= ~(1 << (uint8_t)(bit)); } while(0)
|
||||||
|
|
||||||
// Get n-th bit
|
// Get n-th bit
|
||||||
#define read_bit(reg, bit) (((reg) >> (uint8_t)(bit)) & 0x1)
|
#define get_bit(reg, bit) (((reg) >> (uint8_t)(bit)) & 0x1)
|
||||||
#define get_bit(reg, bit) read_bit(reg, bit)
|
|
||||||
|
|
||||||
// Test n-th bit (Can't use bit_is_set, as it's redefined in sfr_def.h)
|
// Test n-th bit (Can't use bit_is_set, as it's redefined in sfr_def.h)
|
||||||
#define bit_is_high(reg, bit) read_bit(reg, bit)
|
#define bit_is_high(reg, bit) get_bit(reg, bit)
|
||||||
#define bit_is_low(reg, bit) (!read_bit(reg, bit))
|
#define bit_is_low(reg, bit) (!get_bit(reg, bit))
|
||||||
|
|
||||||
// Write value to n-th bit
|
// Write value to n-th bit
|
||||||
#define write_bit(reg, bit, value) do { (reg) = ((reg) & ~(1 << (uint8_t)(bit))) | (((uint8_t)(value) & 0x1) << (uint8_t)(bit)); } while(0)
|
#define set_bit(reg, bit, value) do { (reg) = ((reg) & ~(1 << (uint8_t)(bit))) | (((uint8_t)(value) & 0x1) << (uint8_t)(bit)); } while(0)
|
||||||
#define set_bit(reg, bit, value) write_bit(reg, bit, value)
|
|
||||||
|
|
||||||
// Invert n-th bit
|
// Invert n-th bit
|
||||||
#define toggle_bit(reg, bit) do { (reg) ^= (1 << (uint8_t)(bit)); } while(0)
|
#define toggle_bit(reg, bit) do { (reg) ^= (1 << (uint8_t)(bit)); } while(0)
|
||||||
@@ -53,27 +51,25 @@
|
|||||||
#define cbi_p(reg_p, bit) do { (*(reg_p)) &= ~(1 << (uint8_t)(bit)); } while(0)
|
#define cbi_p(reg_p, bit) do { (*(reg_p)) &= ~(1 << (uint8_t)(bit)); } while(0)
|
||||||
|
|
||||||
// Get n-th bit in pointee
|
// Get n-th bit in pointee
|
||||||
#define read_bit_p(reg_p, bit) ((*(reg_p) >> (uint8_t)(bit)) & 0x1)
|
#define get_bit_p(reg_p, bit) ((*(reg_p) >> (uint8_t)(bit)) & 0x1)
|
||||||
#define get_bit_p(reg_p, bit) read_bit_p(reg_p, bit)
|
|
||||||
|
|
||||||
// Test n-th bit in pointee (Can't use bit_is_set, as it's redefined in sfr_def.h)
|
// Test n-th bit in pointee (Can't use bit_is_set, as it's redefined in sfr_def.h)
|
||||||
#define bit_is_high_p(reg_p, bit) read_bit_p(reg_p, bit)
|
#define bit_is_high_p(reg_p, bit) get_bit_p(reg_p, bit)
|
||||||
#define bit_is_low_p(reg_p, bit) (!read_bit_p(reg_p, bit))
|
#define bit_is_low_p(reg_p, bit) (!get_bit_p(reg_p, bit))
|
||||||
|
|
||||||
// Write value to a bit in pointee
|
// Write value to a bit in pointee
|
||||||
#define write_bit_p(reg_p, bit, value) do { *(reg_p) = (*(reg_p) & ~(1 << ((uint8_t)(bit) & 0x1))) | (((uint8_t)(value) & 0x1) << (uint8_t)(bit)); } while(0)
|
#define set_bit_p(reg_p, bit, value) do { *(reg_p) = (*(reg_p) & ~(1 << ((uint8_t)(bit) & 0x1))) | (((uint8_t)(value) & 0x1) << (uint8_t)(bit)); } while(0)
|
||||||
#define set_bit_p(reg_p, bit, value) write_bit_p(reg_p, bit, value)
|
|
||||||
#define toggle_bit_p(reg_p, bit) do { *(reg_p) ^= (1 << (uint8_t)(bit)); } while(0)
|
#define toggle_bit_p(reg_p, bit) do { *(reg_p) ^= (1 << (uint8_t)(bit)); } while(0)
|
||||||
|
|
||||||
|
|
||||||
// --- Nibble manipulation ---
|
// --- Nibble manipulation ---
|
||||||
|
|
||||||
// Replace nibble in a byte
|
// Replace nibble in a byte
|
||||||
#define write_low_nibble(reg, value) do { (reg) = ((reg) & 0xF0) | ((uint8_t)(value) & 0xF); } while(0)
|
#define set_low_nibble(reg, value) do { (reg) = ((reg) & 0xF0) | ((uint8_t)(value) & 0xF); } while(0)
|
||||||
#define write_high_nibble(reg, value) do { (reg) = ((reg) & 0x0F) | (((uint8_t)(value) & 0xF) << 4); } while(0)
|
#define set_high_nibble(reg, value) do { (reg) = ((reg) & 0x0F) | (((uint8_t)(value) & 0xF) << 4); } while(0)
|
||||||
|
|
||||||
#define write_low_nibble_p(reg_p, value) do { *(reg_p) = (*(reg_p) & 0xF0) | ((uint8_t)(value) & 0xF); } while(0)
|
#define set_low_nibble_p(reg_p, value) do { *(reg_p) = (*(reg_p) & 0xF0) | ((uint8_t)(value) & 0xF); } while(0)
|
||||||
#define write_high_nibble_p(reg_p, value) do { *(reg_p) = (*(reg_p) & 0x0F) | (((uint8_t)(value) & 0xF) << 4); } while(0)
|
#define set_high_nibble_p(reg_p, value) do { *(reg_p) = (*(reg_p) & 0x0F) | (((uint8_t)(value) & 0xF) << 4); } while(0)
|
||||||
|
|
||||||
#define low_nibble(x) ((uint8_t)(x) & 0xF)
|
#define low_nibble(x) ((uint8_t)(x) & 0xF)
|
||||||
#define high_nibble(x) (((uint8_t)(x) & 0xF0) >> 4)
|
#define high_nibble(x) (((uint8_t)(x) & 0xF0) >> 4)
|
||||||
|
|||||||
+1
-1
@@ -3,7 +3,7 @@
|
|||||||
|
|
||||||
#include "debounce.h"
|
#include "debounce.h"
|
||||||
#include "calc.h"
|
#include "calc.h"
|
||||||
#include "pins.h"
|
#include "iopins.h"
|
||||||
#include "debo_config.h"
|
#include "debo_config.h"
|
||||||
|
|
||||||
/** Debounce data array */
|
/** Debounce data array */
|
||||||
|
|||||||
+5
-5
@@ -16,8 +16,8 @@
|
|||||||
//
|
//
|
||||||
// A pin is registered like this:
|
// A pin is registered like this:
|
||||||
//
|
//
|
||||||
// #define BTN1 B,0
|
// #define BTN1 12 // pin D12
|
||||||
// #define BTN2 B,1
|
// #define BTN2 13
|
||||||
//
|
//
|
||||||
// debo_add(BTN0); // The function returns number assigned to the pin (0, 1, ...)
|
// debo_add(BTN0); // The function returns number assigned to the pin (0, 1, ...)
|
||||||
// debo_add_rev(BTN1); // active low
|
// debo_add_rev(BTN1); // active low
|
||||||
@@ -50,9 +50,9 @@ typedef struct {
|
|||||||
|
|
||||||
debo_slot_t debo_slots[DEBO_CHANNELS];
|
debo_slot_t debo_slots[DEBO_CHANNELS];
|
||||||
|
|
||||||
/** Add a pin for debouncing */
|
/** Add a pin for debouncing (must be used with constant args) */
|
||||||
#define debo_add_rev(io) debo_register(&io2pin(io_pack(io)), io2n(io_pack(io)), 1)
|
#define debo_add_rev(pin) debo_register(&_pin(pin), _pn(pin), 1)
|
||||||
#define debo_add(io) debo_register(&io2pin(io_pack(io)), io2n(io_pack(io)), 0)
|
#define debo_add(pin) debo_register(&_pin(pin), _pn(pin), 0)
|
||||||
|
|
||||||
/** Add a pin for debouncing (low level function) */
|
/** Add a pin for debouncing (low level function) */
|
||||||
uint8_t debo_register(PORT_P pin_reg_pointer, uint8_t bit, bool invert);
|
uint8_t debo_register(PORT_P pin_reg_pointer, uint8_t bit, bool invert);
|
||||||
|
|||||||
+276
@@ -0,0 +1,276 @@
|
|||||||
|
#include <avr/io.h>
|
||||||
|
#include <stdbool.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#include "calc.h"
|
||||||
|
#include "iopins.h"
|
||||||
|
|
||||||
|
|
||||||
|
void set_dir_n(const uint8_t pin, const uint8_t d)
|
||||||
|
{
|
||||||
|
switch(pin) {
|
||||||
|
case 0: set_dir(0, d); return;
|
||||||
|
case 1: set_dir(1, d); return;
|
||||||
|
case 2: set_dir(2, d); return;
|
||||||
|
case 3: set_dir(3, d); return;
|
||||||
|
case 4: set_dir(4, d); return;
|
||||||
|
case 5: set_dir(5, d); return;
|
||||||
|
case 6: set_dir(6, d); return;
|
||||||
|
case 7: set_dir(7, d); return;
|
||||||
|
case 8: set_dir(8, d); return;
|
||||||
|
case 9: set_dir(9, d); return;
|
||||||
|
case 10: set_dir(10, d); return;
|
||||||
|
case 11: set_dir(11, d); return;
|
||||||
|
case 12: set_dir(12, d); return;
|
||||||
|
case 13: set_dir(13, d); return;
|
||||||
|
case 14: set_dir(14, d); return;
|
||||||
|
case 15: set_dir(15, d); return;
|
||||||
|
case 16: set_dir(16, d); return;
|
||||||
|
case 17: set_dir(17, d); return;
|
||||||
|
case 18: set_dir(18, d); return;
|
||||||
|
case 19: set_dir(19, d); return;
|
||||||
|
case 20: set_dir(20, d); return;
|
||||||
|
case 21: set_dir(21, d); return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void as_input_n(const uint8_t pin)
|
||||||
|
{
|
||||||
|
switch(pin) {
|
||||||
|
case 0: as_input(0); return;
|
||||||
|
case 1: as_input(1); return;
|
||||||
|
case 2: as_input(2); return;
|
||||||
|
case 3: as_input(3); return;
|
||||||
|
case 4: as_input(4); return;
|
||||||
|
case 5: as_input(5); return;
|
||||||
|
case 6: as_input(6); return;
|
||||||
|
case 7: as_input(7); return;
|
||||||
|
case 8: as_input(8); return;
|
||||||
|
case 9: as_input(9); return;
|
||||||
|
case 10: as_input(10); return;
|
||||||
|
case 11: as_input(11); return;
|
||||||
|
case 12: as_input(12); return;
|
||||||
|
case 13: as_input(13); return;
|
||||||
|
case 14: as_input(14); return;
|
||||||
|
case 15: as_input(15); return;
|
||||||
|
case 16: as_input(16); return;
|
||||||
|
case 17: as_input(17); return;
|
||||||
|
case 18: as_input(18); return;
|
||||||
|
case 19: as_input(19); return;
|
||||||
|
case 20: as_input(20); return;
|
||||||
|
case 21: as_input(21); return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void as_input_pu_n(const uint8_t pin)
|
||||||
|
{
|
||||||
|
switch(pin) {
|
||||||
|
case 0: as_input_pu(0); return;
|
||||||
|
case 1: as_input_pu(1); return;
|
||||||
|
case 2: as_input_pu(2); return;
|
||||||
|
case 3: as_input_pu(3); return;
|
||||||
|
case 4: as_input_pu(4); return;
|
||||||
|
case 5: as_input_pu(5); return;
|
||||||
|
case 6: as_input_pu(6); return;
|
||||||
|
case 7: as_input_pu(7); return;
|
||||||
|
case 8: as_input_pu(8); return;
|
||||||
|
case 9: as_input_pu(9); return;
|
||||||
|
case 10: as_input_pu(10); return;
|
||||||
|
case 11: as_input_pu(11); return;
|
||||||
|
case 12: as_input_pu(12); return;
|
||||||
|
case 13: as_input_pu(13); return;
|
||||||
|
case 14: as_input_pu(14); return;
|
||||||
|
case 15: as_input_pu(15); return;
|
||||||
|
case 16: as_input_pu(16); return;
|
||||||
|
case 17: as_input_pu(17); return;
|
||||||
|
case 18: as_input_pu(18); return;
|
||||||
|
case 19: as_input_pu(19); return;
|
||||||
|
case 20: as_input_pu(20); return;
|
||||||
|
case 21: as_input_pu(21); return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void as_output_n(const uint8_t pin)
|
||||||
|
{
|
||||||
|
switch(pin) {
|
||||||
|
case 0: as_output(0); return;
|
||||||
|
case 1: as_output(1); return;
|
||||||
|
case 2: as_output(2); return;
|
||||||
|
case 3: as_output(3); return;
|
||||||
|
case 4: as_output(4); return;
|
||||||
|
case 5: as_output(5); return;
|
||||||
|
case 6: as_output(6); return;
|
||||||
|
case 7: as_output(7); return;
|
||||||
|
case 8: as_output(8); return;
|
||||||
|
case 9: as_output(9); return;
|
||||||
|
case 10: as_output(10); return;
|
||||||
|
case 11: as_output(11); return;
|
||||||
|
case 12: as_output(12); return;
|
||||||
|
case 13: as_output(13); return;
|
||||||
|
case 14: as_output(14); return;
|
||||||
|
case 15: as_output(15); return;
|
||||||
|
case 16: as_output(16); return;
|
||||||
|
case 17: as_output(17); return;
|
||||||
|
case 18: as_output(18); return;
|
||||||
|
case 19: as_output(19); return;
|
||||||
|
case 20: as_output(20); return;
|
||||||
|
case 21: as_output(21); return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void set_pin_n(const uint8_t pin, const uint8_t v)
|
||||||
|
{
|
||||||
|
switch(pin) {
|
||||||
|
case 0: set_pin(0, v); return;
|
||||||
|
case 1: set_pin(1, v); return;
|
||||||
|
case 2: set_pin(2, v); return;
|
||||||
|
case 3: set_pin(3, v); return;
|
||||||
|
case 4: set_pin(4, v); return;
|
||||||
|
case 5: set_pin(5, v); return;
|
||||||
|
case 6: set_pin(6, v); return;
|
||||||
|
case 7: set_pin(7, v); return;
|
||||||
|
case 8: set_pin(8, v); return;
|
||||||
|
case 9: set_pin(9, v); return;
|
||||||
|
case 10: set_pin(10, v); return;
|
||||||
|
case 11: set_pin(11, v); return;
|
||||||
|
case 12: set_pin(12, v); return;
|
||||||
|
case 13: set_pin(13, v); return;
|
||||||
|
case 14: set_pin(14, v); return;
|
||||||
|
case 15: set_pin(15, v); return;
|
||||||
|
case 16: set_pin(16, v); return;
|
||||||
|
case 17: set_pin(17, v); return;
|
||||||
|
case 18: set_pin(18, v); return;
|
||||||
|
case 19: set_pin(19, v); return;
|
||||||
|
case 20: set_pin(20, v); return;
|
||||||
|
case 21: set_pin(21, v); return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void set_low_n(const uint8_t pin)
|
||||||
|
{
|
||||||
|
switch(pin) {
|
||||||
|
case 0: set_low(0); return;
|
||||||
|
case 1: set_low(1); return;
|
||||||
|
case 2: set_low(2); return;
|
||||||
|
case 3: set_low(3); return;
|
||||||
|
case 4: set_low(4); return;
|
||||||
|
case 5: set_low(5); return;
|
||||||
|
case 6: set_low(6); return;
|
||||||
|
case 7: set_low(7); return;
|
||||||
|
case 8: set_low(8); return;
|
||||||
|
case 9: set_low(9); return;
|
||||||
|
case 10: set_low(10); return;
|
||||||
|
case 11: set_low(11); return;
|
||||||
|
case 12: set_low(12); return;
|
||||||
|
case 13: set_low(13); return;
|
||||||
|
case 14: set_low(14); return;
|
||||||
|
case 15: set_low(15); return;
|
||||||
|
case 16: set_low(16); return;
|
||||||
|
case 17: set_low(17); return;
|
||||||
|
case 18: set_low(18); return;
|
||||||
|
case 19: set_low(19); return;
|
||||||
|
case 20: set_low(20); return;
|
||||||
|
case 21: set_low(21); return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void set_high_n(const uint8_t pin)
|
||||||
|
{
|
||||||
|
switch(pin) {
|
||||||
|
case 0: set_high(0); return;
|
||||||
|
case 1: set_high(1); return;
|
||||||
|
case 2: set_high(2); return;
|
||||||
|
case 3: set_high(3); return;
|
||||||
|
case 4: set_high(4); return;
|
||||||
|
case 5: set_high(5); return;
|
||||||
|
case 6: set_high(6); return;
|
||||||
|
case 7: set_high(7); return;
|
||||||
|
case 8: set_high(8); return;
|
||||||
|
case 9: set_high(9); return;
|
||||||
|
case 10: set_high(10); return;
|
||||||
|
case 11: set_high(11); return;
|
||||||
|
case 12: set_high(12); return;
|
||||||
|
case 13: set_high(13); return;
|
||||||
|
case 14: set_high(14); return;
|
||||||
|
case 15: set_high(15); return;
|
||||||
|
case 16: set_high(16); return;
|
||||||
|
case 17: set_high(17); return;
|
||||||
|
case 18: set_high(18); return;
|
||||||
|
case 19: set_high(19); return;
|
||||||
|
case 20: set_high(20); return;
|
||||||
|
case 21: set_high(21); return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void toggle_pin_n(const uint8_t pin)
|
||||||
|
{
|
||||||
|
switch(pin) {
|
||||||
|
case 0: toggle_pin(0); return;
|
||||||
|
case 1: toggle_pin(1); return;
|
||||||
|
case 2: toggle_pin(2); return;
|
||||||
|
case 3: toggle_pin(3); return;
|
||||||
|
case 4: toggle_pin(4); return;
|
||||||
|
case 5: toggle_pin(5); return;
|
||||||
|
case 6: toggle_pin(6); return;
|
||||||
|
case 7: toggle_pin(7); return;
|
||||||
|
case 8: toggle_pin(8); return;
|
||||||
|
case 9: toggle_pin(9); return;
|
||||||
|
case 10: toggle_pin(10); return;
|
||||||
|
case 11: toggle_pin(11); return;
|
||||||
|
case 12: toggle_pin(12); return;
|
||||||
|
case 13: toggle_pin(13); return;
|
||||||
|
case 14: toggle_pin(14); return;
|
||||||
|
case 15: toggle_pin(15); return;
|
||||||
|
case 16: toggle_pin(16); return;
|
||||||
|
case 17: toggle_pin(17); return;
|
||||||
|
case 18: toggle_pin(18); return;
|
||||||
|
case 19: toggle_pin(19); return;
|
||||||
|
case 20: toggle_pin(20); return;
|
||||||
|
case 21: toggle_pin(21); return;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
bool get_pin_n(const uint8_t pin)
|
||||||
|
{
|
||||||
|
switch(pin) {
|
||||||
|
case 0: return get_pin(0);
|
||||||
|
case 1: return get_pin(1);
|
||||||
|
case 2: return get_pin(2);
|
||||||
|
case 3: return get_pin(3);
|
||||||
|
case 4: return get_pin(4);
|
||||||
|
case 5: return get_pin(5);
|
||||||
|
case 6: return get_pin(6);
|
||||||
|
case 7: return get_pin(7);
|
||||||
|
case 8: return get_pin(8);
|
||||||
|
case 9: return get_pin(9);
|
||||||
|
case 10: return get_pin(10);
|
||||||
|
case 11: return get_pin(11);
|
||||||
|
case 12: return get_pin(12);
|
||||||
|
case 13: return get_pin(13);
|
||||||
|
case 14: return get_pin(14);
|
||||||
|
case 15: return get_pin(15);
|
||||||
|
case 16: return get_pin(16);
|
||||||
|
case 17: return get_pin(17);
|
||||||
|
case 18: return get_pin(18);
|
||||||
|
case 19: return get_pin(19);
|
||||||
|
case 20: return get_pin(20);
|
||||||
|
case 21: return get_pin(21);
|
||||||
|
}
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
bool is_low_n(const uint8_t pin)
|
||||||
|
{
|
||||||
|
return !get_pin_n(pin);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
bool is_high_n(const uint8_t pin)
|
||||||
|
{
|
||||||
|
return get_pin_n(pin);
|
||||||
|
}
|
||||||
+213
@@ -0,0 +1,213 @@
|
|||||||
|
#pragma once
|
||||||
|
|
||||||
|
//
|
||||||
|
// * Utilities for pin aliasing / numbering. *
|
||||||
|
//
|
||||||
|
// Designed for Arduino.
|
||||||
|
//
|
||||||
|
// If you know the pin number beforehand, you can use the macros.
|
||||||
|
//
|
||||||
|
// If you need to use a variable for pin number, use the `_n` functions.
|
||||||
|
// They are much slower, so always check if you really need them
|
||||||
|
// - and they aren't fit for things where precise timing is required.
|
||||||
|
//
|
||||||
|
|
||||||
|
#include <avr/io.h>
|
||||||
|
#include <stdbool.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#include "calc.h"
|
||||||
|
|
||||||
|
|
||||||
|
// type: pointer to port
|
||||||
|
typedef volatile uint8_t* PORT_P;
|
||||||
|
|
||||||
|
|
||||||
|
/** Pin numbering reference */
|
||||||
|
#define D0 0
|
||||||
|
#define D1 1
|
||||||
|
#define D2 2
|
||||||
|
#define D3 3
|
||||||
|
#define D4 4
|
||||||
|
#define D5 5
|
||||||
|
#define D6 6
|
||||||
|
#define D7 7
|
||||||
|
#define D8 8
|
||||||
|
#define D9 9
|
||||||
|
#define D10 10
|
||||||
|
#define D11 11
|
||||||
|
#define D12 12
|
||||||
|
#define D13 13
|
||||||
|
#define D14 14
|
||||||
|
#define D15 15
|
||||||
|
#define D16 16
|
||||||
|
#define D17 17
|
||||||
|
#define D18 18
|
||||||
|
#define D19 19
|
||||||
|
#define D20 20
|
||||||
|
#define D21 21
|
||||||
|
#define A0 14
|
||||||
|
#define A1 15
|
||||||
|
#define A2 16
|
||||||
|
#define A3 17
|
||||||
|
#define A4 18
|
||||||
|
#define A5 19
|
||||||
|
#define A6 20
|
||||||
|
#define A7 21
|
||||||
|
|
||||||
|
|
||||||
|
#define _ddr(pin) _DDR_##pin
|
||||||
|
#define _pin(pin) _PIN_##pin
|
||||||
|
#define _pn(pin) _PN_##pin
|
||||||
|
#define _port(pin) _PORT_##pin
|
||||||
|
|
||||||
|
|
||||||
|
/** Set pin direction */
|
||||||
|
#define set_dir(pin, d) set_bit( _ddr(pin), _pn(pin), d )
|
||||||
|
void set_dir_n(const uint8_t pin, const uint8_t d);
|
||||||
|
|
||||||
|
|
||||||
|
/** Configure pin as input */
|
||||||
|
#define as_input(pin) cbi( _ddr(pin), _pn(pin) )
|
||||||
|
void as_input_n(const uint8_t pin);
|
||||||
|
|
||||||
|
|
||||||
|
/** Configure pin as input, with pull-up enabled */
|
||||||
|
#define as_input_pu(pin) { as_input(pin); set_high(pin); }
|
||||||
|
void as_input_pu_n(const uint8_t pin);
|
||||||
|
|
||||||
|
|
||||||
|
/** Configure pin as output */
|
||||||
|
#define as_output(pin) sbi( _ddr(pin), _pn(pin) )
|
||||||
|
void as_output_n(const uint8_t pin);
|
||||||
|
|
||||||
|
|
||||||
|
/** Write value to a pin */
|
||||||
|
#define set_pin(pin, v) set_bit( _port(pin), _pn(pin), v )
|
||||||
|
void set_pin_n(const uint8_t pin, const uint8_t v);
|
||||||
|
|
||||||
|
|
||||||
|
/** Write 0 to a pin */
|
||||||
|
#define set_low(pin) cbi( _port(pin), _pn(pin) )
|
||||||
|
void set_low_n(const uint8_t pin);
|
||||||
|
|
||||||
|
|
||||||
|
/** Write 1 to a pin */
|
||||||
|
#define set_high(pin) sbi( _port(pin), _pn(pin) )
|
||||||
|
void set_high_n(const uint8_t pin);
|
||||||
|
|
||||||
|
|
||||||
|
/** Toggle a pin state */
|
||||||
|
#define toggle_pin(pin) sbi( _pin(pin), _pn(pin) )
|
||||||
|
void toggle_pin_n(const uint8_t pin);
|
||||||
|
|
||||||
|
|
||||||
|
/** Read a pin value */
|
||||||
|
#define get_pin(pin) get_bit( _pin(pin), _pn(pin) )
|
||||||
|
bool get_pin_n(const uint8_t pin);
|
||||||
|
|
||||||
|
|
||||||
|
/** CHeck if pin is low */
|
||||||
|
#define is_low(pin) (get_pin(pin) == 0)
|
||||||
|
bool is_low_n(const uint8_t pin);
|
||||||
|
|
||||||
|
|
||||||
|
/** CHeck if pin is high */
|
||||||
|
#define is_high(pin) (get_pin(pin) != 0)
|
||||||
|
bool is_high_n(const uint8_t pin);
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
// Helper macros
|
||||||
|
|
||||||
|
#define _PORT_0 PORTD
|
||||||
|
#define _PORT_1 PORTD
|
||||||
|
#define _PORT_2 PORTD
|
||||||
|
#define _PORT_3 PORTD
|
||||||
|
#define _PORT_4 PORTD
|
||||||
|
#define _PORT_5 PORTD
|
||||||
|
#define _PORT_6 PORTD
|
||||||
|
#define _PORT_7 PORTD
|
||||||
|
#define _PORT_8 PORTB
|
||||||
|
#define _PORT_9 PORTB
|
||||||
|
#define _PORT_10 PORTB
|
||||||
|
#define _PORT_11 PORTB
|
||||||
|
#define _PORT_12 PORTB
|
||||||
|
#define _PORT_13 PORTB
|
||||||
|
#define _PORT_14 PORTC
|
||||||
|
#define _PORT_15 PORTC
|
||||||
|
#define _PORT_16 PORTC
|
||||||
|
#define _PORT_17 PORTC
|
||||||
|
#define _PORT_18 PORTC
|
||||||
|
#define _PORT_19 PORTC
|
||||||
|
#define _PORT_20 PORTC
|
||||||
|
#define _PORT_21 PORTC
|
||||||
|
|
||||||
|
#define _PIN_0 PIND
|
||||||
|
#define _PIN_1 PIND
|
||||||
|
#define _PIN_2 PIND
|
||||||
|
#define _PIN_3 PIND
|
||||||
|
#define _PIN_4 PIND
|
||||||
|
#define _PIN_5 PIND
|
||||||
|
#define _PIN_6 PIND
|
||||||
|
#define _PIN_7 PIND
|
||||||
|
#define _PIN_8 PINB
|
||||||
|
#define _PIN_9 PINB
|
||||||
|
#define _PIN_10 PINB
|
||||||
|
#define _PIN_11 PINB
|
||||||
|
#define _PIN_12 PINB
|
||||||
|
#define _PIN_13 PINB
|
||||||
|
#define _PIN_14 PINC
|
||||||
|
#define _PIN_15 PINC
|
||||||
|
#define _PIN_16 PINC
|
||||||
|
#define _PIN_17 PINC
|
||||||
|
#define _PIN_18 PINC
|
||||||
|
#define _PIN_19 PINC
|
||||||
|
#define _PIN_20 PINC
|
||||||
|
#define _PIN_21 PINC
|
||||||
|
|
||||||
|
#define _DDR_0 DDRD
|
||||||
|
#define _DDR_1 DDRD
|
||||||
|
#define _DDR_2 DDRD
|
||||||
|
#define _DDR_3 DDRD
|
||||||
|
#define _DDR_4 DDRD
|
||||||
|
#define _DDR_5 DDRD
|
||||||
|
#define _DDR_6 DDRD
|
||||||
|
#define _DDR_7 DDRD
|
||||||
|
#define _DDR_8 DDRB
|
||||||
|
#define _DDR_9 DDRB
|
||||||
|
#define _DDR_10 DDRB
|
||||||
|
#define _DDR_11 DDRB
|
||||||
|
#define _DDR_12 DDRB
|
||||||
|
#define _DDR_13 DDRB
|
||||||
|
#define _DDR_14 DDRC
|
||||||
|
#define _DDR_15 DDRC
|
||||||
|
#define _DDR_16 DDRC
|
||||||
|
#define _DDR_17 DDRC
|
||||||
|
#define _DDR_18 DDRC
|
||||||
|
#define _DDR_19 DDRC
|
||||||
|
#define _DDR_20 DDRC
|
||||||
|
#define _DDR_21 DDRC
|
||||||
|
|
||||||
|
#define _PN_0 0
|
||||||
|
#define _PN_1 1
|
||||||
|
#define _PN_2 2
|
||||||
|
#define _PN_3 3
|
||||||
|
#define _PN_4 4
|
||||||
|
#define _PN_5 5
|
||||||
|
#define _PN_6 6
|
||||||
|
#define _PN_7 7
|
||||||
|
#define _PN_8 0
|
||||||
|
#define _PN_9 1
|
||||||
|
#define _PN_10 2
|
||||||
|
#define _PN_11 3
|
||||||
|
#define _PN_12 4
|
||||||
|
#define _PN_13 5
|
||||||
|
#define _PN_14 0
|
||||||
|
#define _PN_15 1
|
||||||
|
#define _PN_16 2
|
||||||
|
#define _PN_17 3
|
||||||
|
#define _PN_18 4
|
||||||
|
#define _PN_19 5
|
||||||
|
#define _PN_20 6
|
||||||
|
#define _PN_21 7
|
||||||
@@ -32,10 +32,10 @@ uint8_t _lcd_read_byte();
|
|||||||
#define _lcd_write_low(bb) _lcd_write_nibble((bb) & 0x0F)
|
#define _lcd_write_low(bb) _lcd_write_nibble((bb) & 0x0F)
|
||||||
#define _lcd_write_high(bb) _lcd_write_nibble(((bb) & 0xF0) >> 4)
|
#define _lcd_write_high(bb) _lcd_write_nibble(((bb) & 0xF0) >> 4)
|
||||||
#define _lcd_write_nibble(nib) do { \
|
#define _lcd_write_nibble(nib) do { \
|
||||||
write_pin(LCD_D7, get_bit((nib), 3)); \
|
set_pin(LCD_D7, get_bit((nib), 3)); \
|
||||||
write_pin(LCD_D6, get_bit((nib), 2)); \
|
set_pin(LCD_D6, get_bit((nib), 2)); \
|
||||||
write_pin(LCD_D5, get_bit((nib), 1)); \
|
set_pin(LCD_D5, get_bit((nib), 1)); \
|
||||||
write_pin(LCD_D4, get_bit((nib), 0)); \
|
set_pin(LCD_D4, get_bit((nib), 0)); \
|
||||||
} while(0)
|
} while(0)
|
||||||
|
|
||||||
|
|
||||||
@@ -100,9 +100,9 @@ void lcd_init()
|
|||||||
/** Send a pulse on the ENABLE line */
|
/** Send a pulse on the ENABLE line */
|
||||||
void _lcd_clk()
|
void _lcd_clk()
|
||||||
{
|
{
|
||||||
pin_up(LCD_E);
|
set_high(LCD_E);
|
||||||
delay_ns(450);
|
delay_ns(450);
|
||||||
pin_down(LCD_E);
|
set_low(LCD_E);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@@ -111,7 +111,7 @@ void _lcd_mode_r()
|
|||||||
{
|
{
|
||||||
if (_lcd_mode == 1) return; // already in R mode
|
if (_lcd_mode == 1) return; // already in R mode
|
||||||
|
|
||||||
pin_up(LCD_RW);
|
set_high(LCD_RW);
|
||||||
|
|
||||||
as_input_pu(LCD_D7);
|
as_input_pu(LCD_D7);
|
||||||
as_input_pu(LCD_D6);
|
as_input_pu(LCD_D6);
|
||||||
@@ -127,7 +127,7 @@ void _lcd_mode_w()
|
|||||||
{
|
{
|
||||||
if (_lcd_mode == 0) return; // already in W mode
|
if (_lcd_mode == 0) return; // already in W mode
|
||||||
|
|
||||||
pin_down(LCD_RW);
|
set_low(LCD_RW);
|
||||||
|
|
||||||
as_output(LCD_D7);
|
as_output(LCD_D7);
|
||||||
as_output(LCD_D6);
|
as_output(LCD_D6);
|
||||||
@@ -146,10 +146,10 @@ uint8_t _lcd_read_byte()
|
|||||||
uint8_t res = 0;
|
uint8_t res = 0;
|
||||||
|
|
||||||
_lcd_clk();
|
_lcd_clk();
|
||||||
res = (read_pin(LCD_D7) << 7) | (read_pin(LCD_D6) << 6) | (read_pin(LCD_D5) << 5) | (read_pin(LCD_D4) << 4);
|
res = (get_pin(LCD_D7) << 7) | (get_pin(LCD_D6) << 6) | (get_pin(LCD_D5) << 5) | (get_pin(LCD_D4) << 4);
|
||||||
|
|
||||||
_lcd_clk();
|
_lcd_clk();
|
||||||
res |= (read_pin(LCD_D7) << 3) | (read_pin(LCD_D6) << 2) | (read_pin(LCD_D5) << 1) | (read_pin(LCD_D4) << 0);
|
res |= (get_pin(LCD_D7) << 3) | (get_pin(LCD_D6) << 2) | (get_pin(LCD_D5) << 1) | (get_pin(LCD_D4) << 0);
|
||||||
|
|
||||||
return res;
|
return res;
|
||||||
}
|
}
|
||||||
@@ -159,7 +159,7 @@ uint8_t _lcd_read_byte()
|
|||||||
void lcd_command(uint8_t bb)
|
void lcd_command(uint8_t bb)
|
||||||
{
|
{
|
||||||
_lcd_wait_bf();
|
_lcd_wait_bf();
|
||||||
pin_down(LCD_RS); // select instruction register
|
set_low(LCD_RS); // select instruction register
|
||||||
_lcd_write_byte(bb); // send instruction byte
|
_lcd_write_byte(bb); // send instruction byte
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -186,7 +186,7 @@ void lcd_write(uint8_t bb)
|
|||||||
}
|
}
|
||||||
|
|
||||||
_lcd_wait_bf();
|
_lcd_wait_bf();
|
||||||
pin_up(LCD_RS); // select data register
|
set_high(LCD_RS); // select data register
|
||||||
_lcd_write_byte(bb); // send data byte
|
_lcd_write_byte(bb); // send data byte
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -194,7 +194,7 @@ void lcd_write(uint8_t bb)
|
|||||||
/** Read BF & Address */
|
/** Read BF & Address */
|
||||||
uint8_t lcd_read_bf_addr()
|
uint8_t lcd_read_bf_addr()
|
||||||
{
|
{
|
||||||
pin_down(LCD_RS);
|
set_low(LCD_RS);
|
||||||
return _lcd_read_byte();
|
return _lcd_read_byte();
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -204,7 +204,7 @@ uint8_t lcd_read()
|
|||||||
{
|
{
|
||||||
if (_addrtype == TEXT) _pos.x++;
|
if (_addrtype == TEXT) _pos.x++;
|
||||||
|
|
||||||
pin_up(LCD_RS);
|
set_high(LCD_RS);
|
||||||
return _lcd_read_byte();
|
return _lcd_read_byte();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
-22
@@ -1,22 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
//
|
|
||||||
// Custom loops
|
|
||||||
//
|
|
||||||
|
|
||||||
// Repeat code n times (uint8_t counter)
|
|
||||||
#define repeat(count) repeat_aux(count, _repeat_##__COUNTER__)
|
|
||||||
#define repeat_aux(count, cntvar) for (uint8_t cntvar = 0; cntvar < (count); cntvar++)
|
|
||||||
|
|
||||||
// Repeat code n times (uint16_t counter)
|
|
||||||
#define repeatx(count) repeatx_aux(count, _repeatx_##__COUNTER__)
|
|
||||||
#define repeatx_aux(count, cntvar) for (uint16_t cntvar = 0; cntvar < (count); cntvar++)
|
|
||||||
|
|
||||||
// Repeat with custom counter name (uint8_t)
|
|
||||||
#define loop(var, count) repeat_aux(count, var)
|
|
||||||
// ..., uint16_t
|
|
||||||
#define loopx(var, count) repeatx_aux(count, var)
|
|
||||||
|
|
||||||
// Do until condition is met
|
|
||||||
#define until(what) while(!(what))
|
|
||||||
|
|
||||||
@@ -1,6 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
// Weird constructs for the compiler
|
|
||||||
|
|
||||||
// general macros
|
|
||||||
#define SECTION(pos) __attribute__((naked, used, section(pos)))
|
|
||||||
-129
@@ -1,129 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
//
|
|
||||||
// This file provides macros for pin manipulation.
|
|
||||||
//
|
|
||||||
// You can define your application pins like so:
|
|
||||||
//
|
|
||||||
// // Led at PORTB, pin 1
|
|
||||||
// #define LED B,1
|
|
||||||
//
|
|
||||||
// // Switch at PORTD, pin 7
|
|
||||||
// #define SW1 D,7
|
|
||||||
//
|
|
||||||
// Now you can use macros from this file to wirh with the pins, eg:
|
|
||||||
//
|
|
||||||
// as_output(LED);
|
|
||||||
// as_input(SW1);
|
|
||||||
// pullup_on(SW1);
|
|
||||||
//
|
|
||||||
// toggle_pin(LED);
|
|
||||||
// while (pin_is_low(SW1));
|
|
||||||
//
|
|
||||||
// - The macros io2XXX() can be used to get literal name of register associated with the pin.
|
|
||||||
// - io2n() provides pin number.
|
|
||||||
// - The underscored and _aux macros are internal and should not be used elsewhere.
|
|
||||||
// - The io_pack() macro is used to pass pin (io) to other macro without expanding it.
|
|
||||||
//
|
|
||||||
|
|
||||||
#include <avr/io.h>
|
|
||||||
#include "calc.h"
|
|
||||||
|
|
||||||
// Helpers
|
|
||||||
// Get particular register associated with the name X (eg. D -> PORTD)
|
|
||||||
#define _reg_ddr(X) DDR ## X
|
|
||||||
#define _reg_port(X) PORT ## X
|
|
||||||
#define _reg_pin(X) PIN ## X
|
|
||||||
#define _io2ddr_aux(reg, bit) _reg_ddr(reg)
|
|
||||||
#define _io2port_aux(reg, bit) _reg_port(reg)
|
|
||||||
#define _io2pin_aux(reg, bit) _reg_pin(reg)
|
|
||||||
#define _io2n_aux(reg, bit) bit
|
|
||||||
|
|
||||||
|
|
||||||
// === Convert A,1 to corresponding register and pin number ===
|
|
||||||
|
|
||||||
#define io2ddr(io) _io2ddr_aux(io)
|
|
||||||
#define io2port(io) _io2port_aux(io)
|
|
||||||
#define io2pin(io) _io2pin_aux(io)
|
|
||||||
#define io2n(io) _io2n_aux(io)
|
|
||||||
|
|
||||||
// === covert "A", "1" to "A,1" for passing on to another macro ===
|
|
||||||
#define io_pack(port, bit) port, bit
|
|
||||||
|
|
||||||
|
|
||||||
// === Useful types for ports and pins ===
|
|
||||||
|
|
||||||
// pointer to port
|
|
||||||
typedef volatile uint8_t* PORT_P;
|
|
||||||
// number of bit in port
|
|
||||||
typedef uint8_t BIT_N;
|
|
||||||
|
|
||||||
|
|
||||||
// === pin manipulation ===
|
|
||||||
|
|
||||||
// Helpers
|
|
||||||
#define _set_pin_aux(port, bit) sbi(_reg_port(port), (bit))
|
|
||||||
#define _clear_pin_aux(port, bit) cbi(_reg_port(port), (bit))
|
|
||||||
#define _read_pin_aux(port, bit) get_bit(_reg_pin(port), (bit))
|
|
||||||
#define _write_pin_aux(port, bit, value) set_bit(_reg_port(port), (bit), (value))
|
|
||||||
#define _toggle_pin_aux(port, bit) sbi(_reg_pin(port), (bit))
|
|
||||||
|
|
||||||
|
|
||||||
// Set pin to HIGH
|
|
||||||
#define pin_up(io) _set_pin_aux(io)
|
|
||||||
#define pin_high(io) _set_pin_aux(io)
|
|
||||||
|
|
||||||
// Set pin to LOW
|
|
||||||
#define pin_down(io) _clear_pin_aux(io)
|
|
||||||
#define pin_low(io) _clear_pin_aux(io)
|
|
||||||
|
|
||||||
// Get input pin value
|
|
||||||
#define get_pin(io) _read_pin_aux(io)
|
|
||||||
#define read_pin(io) _read_pin_aux(io)
|
|
||||||
|
|
||||||
// Check if pin is low or high
|
|
||||||
#define pin_is_low(io) !_read_pin_aux(io)
|
|
||||||
#define pin_is_high(io) _read_pin_aux(io)
|
|
||||||
|
|
||||||
// Write a value to pin
|
|
||||||
#define set_pin(io, value) _write_pin_aux(io, (value))
|
|
||||||
#define write_pin(io, value) _write_pin_aux(io, (value))
|
|
||||||
#define toggle_pin(io) _toggle_pin_aux(io)
|
|
||||||
|
|
||||||
|
|
||||||
// === Setting pin direction ===
|
|
||||||
|
|
||||||
// Helpers
|
|
||||||
#define _as_input_aux(port, bit) cbi(_reg_ddr(port), (bit))
|
|
||||||
#define _as_output_aux(port, bit) sbi(_reg_ddr(port), (bit))
|
|
||||||
#define _set_dir_aux(port, bit, dir) write_bit(_reg_ddr(port), (bit), (dir))
|
|
||||||
|
|
||||||
|
|
||||||
// Pin as input (_pu ... with pull-up)
|
|
||||||
#define as_input(io) _as_input_aux(io)
|
|
||||||
#define as_input_pu(io) do { _as_input_aux(io); _pullup_enable_aux(io); } while(0)
|
|
||||||
|
|
||||||
// Pin as output
|
|
||||||
#define as_output(io) _as_output_aux(io)
|
|
||||||
|
|
||||||
// Set direction (1 ... output)
|
|
||||||
#define set_dir(io, dir) _set_dir_aux(io, (dir))
|
|
||||||
|
|
||||||
|
|
||||||
// === Setting pullup ===
|
|
||||||
|
|
||||||
// Helpers
|
|
||||||
#define _pullup_enable_aux(port, bit) sbi(_reg_port(port), (bit))
|
|
||||||
#define _pullup_disable_aux(port, bit) cbi(_reg_port(port), (bit))
|
|
||||||
#define _set_pullup_aux(port, bit, on) write_bit(_reg_port(port), (bit), (on))
|
|
||||||
|
|
||||||
// Enable pullup
|
|
||||||
#define pullup_enable(io) _pullup_enable_aux(io)
|
|
||||||
#define pullup_on(io) _pullup_enable_aux(io)
|
|
||||||
|
|
||||||
// Disable pullup
|
|
||||||
#define pullup_disable(io) _pullup_disable_aux(io)
|
|
||||||
#define pullup_off(io) _pullup_disable_aux(io)
|
|
||||||
|
|
||||||
// Set pullup to value (1 ... pullup enabled)
|
|
||||||
#define set_pullup(io, on) _set_pullup_aux(io, on)
|
|
||||||
+20
-38
@@ -3,11 +3,11 @@
|
|||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
#include <stdbool.h>
|
#include <stdbool.h>
|
||||||
|
|
||||||
#include "pins.h"
|
#include "iopins.h"
|
||||||
#include "sonar.h"
|
#include "sonar.h"
|
||||||
|
|
||||||
// Currently measured sonar
|
// Currently measured sonar
|
||||||
sonar_t* _sonar_active_so;
|
static sonar_t* _so;
|
||||||
|
|
||||||
// Flag that measurement is in progress
|
// Flag that measurement is in progress
|
||||||
volatile bool sonar_busy;
|
volatile bool sonar_busy;
|
||||||
@@ -24,15 +24,9 @@ void _sonar_init_do(sonar_t* so, PORT_P port, uint8_t ntx, PORT_P pin, uint8_t n
|
|||||||
so->nrx = nrx;
|
so->nrx = nrx;
|
||||||
|
|
||||||
switch((const uint16_t) pin) {
|
switch((const uint16_t) pin) {
|
||||||
case (const uint16_t)&PINB:
|
case ((const uint16_t) &PINB): so->bank = 0; break;
|
||||||
so->bank = 0;
|
case ((const uint16_t) &PINC): so->bank = 1; break;
|
||||||
break;
|
case ((const uint16_t) &PIND): so->bank = 2; break;
|
||||||
case (const uint16_t)&PINC:
|
|
||||||
so->bank = 1;
|
|
||||||
break;
|
|
||||||
case (const uint16_t)&PIND:
|
|
||||||
so->bank = 2;
|
|
||||||
break;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -47,7 +41,7 @@ bool sonar_start(sonar_t* so)
|
|||||||
{
|
{
|
||||||
if (sonar_busy) return false;
|
if (sonar_busy) return false;
|
||||||
|
|
||||||
_sonar_active_so = so;
|
_so = so;
|
||||||
|
|
||||||
sonar_busy = true;
|
sonar_busy = true;
|
||||||
|
|
||||||
@@ -56,37 +50,31 @@ bool sonar_start(sonar_t* so)
|
|||||||
|
|
||||||
// Timer overflow interrupt enable
|
// Timer overflow interrupt enable
|
||||||
// We'll stop measuring on overflow
|
// We'll stop measuring on overflow
|
||||||
TIMSK1 |= (1 << TOIE1);
|
sbi(TIMSK1, TOIE1);
|
||||||
|
|
||||||
// Clear the timer value
|
// Clear the timer value
|
||||||
TCNT1 = 0;
|
TCNT1 = 0;
|
||||||
|
|
||||||
// Set up pin change interrupt mask for the RX pin
|
// Set up pin change interrupt mask for the RX pin
|
||||||
switch(so->bank) {
|
switch(so->bank) {
|
||||||
case 0:
|
case 0: sbi(PCMSK0, so->nrx); break;
|
||||||
PCMSK0 |= (1 << (so->nrx));
|
case 1: sbi(PCMSK1, so->nrx); break;
|
||||||
break;
|
case 2: sbi(PCMSK2, so->nrx); break;
|
||||||
case 1:
|
|
||||||
PCMSK1 |= (1 << (so->nrx));
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
PCMSK2 |= (1 << (so->nrx));
|
|
||||||
break;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// send positive pulse
|
// send positive pulse
|
||||||
*(so->port) |= (1 << so->ntx);
|
sbi_p(so->port, so->ntx);
|
||||||
_delay_us(_SNR_TRIG_TIME);
|
_delay_us(_SNR_TRIG_TIME);
|
||||||
*(so->port) &= ~(1 << so->ntx);
|
cbi_p(so->port, so->ntx);
|
||||||
|
|
||||||
// Wait for start of response
|
// Wait for start of response
|
||||||
while ( (*(so->pin) & (1 << so->nrx)) == 0 );
|
while (bit_is_low_p(so->pin, so->nrx));
|
||||||
|
|
||||||
// Set timer clock source: F_CPU / 8 (0.5 us resolution)
|
// Set timer clock source: F_CPU / 8 (0.5 us resolution)
|
||||||
TCCR1B = (0b010 << CS10);
|
TCCR1B = (0b010 << CS10);
|
||||||
|
|
||||||
// Enable pin change interrupt
|
// Enable pin change interrupt
|
||||||
PCICR |= (1 << (so->bank));
|
sbi(PCICR, so->bank);
|
||||||
|
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
@@ -99,20 +87,14 @@ void _sonar_stop()
|
|||||||
TCCR1B = 0;
|
TCCR1B = 0;
|
||||||
|
|
||||||
// Disable RX pin interrupt mask
|
// Disable RX pin interrupt mask
|
||||||
switch(_sonar_active_so->bank) {
|
switch(_so->bank) {
|
||||||
case 0:
|
case 0: PCMSK0 &= ~(1 << (_so->nrx)); break;
|
||||||
PCMSK0 &= ~(1 << (_sonar_active_so->nrx));
|
case 1: PCMSK1 &= ~(1 << (_so->nrx)); break;
|
||||||
break;
|
case 2: PCMSK2 &= ~(1 << (_so->nrx)); break;
|
||||||
case 1:
|
|
||||||
PCMSK1 &= ~(1 << (_sonar_active_so->nrx));
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
PCMSK2 &= ~(1 << (_sonar_active_so->nrx));
|
|
||||||
break;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// Disable timer1 overflow interrupt
|
// Disable timer1 overflow interrupt
|
||||||
TIMSK1 &= ~(1 << TOIE1);
|
cbi(TIMSK1, TOIE1);
|
||||||
|
|
||||||
sonar_busy = false;
|
sonar_busy = false;
|
||||||
}
|
}
|
||||||
@@ -137,7 +119,7 @@ inline bool sonar_handle_pci()
|
|||||||
return false; // nothing
|
return false; // nothing
|
||||||
}
|
}
|
||||||
|
|
||||||
if (*(_sonar_active_so->pin) & (1 << _sonar_active_so->nrx)) {
|
if (bit_is_high_p(_so->pin, _so->nrx)) {
|
||||||
// rx is high, not our pin change event
|
// rx is high, not our pin change event
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|||||||
+4
-4
@@ -11,7 +11,7 @@
|
|||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
#include <stdbool.h>
|
#include <stdbool.h>
|
||||||
|
|
||||||
#include "lib/pins.h"
|
#include "iopins.h"
|
||||||
|
|
||||||
// Calib constant for the module
|
// Calib constant for the module
|
||||||
// CM = uS / _DIV_CONST
|
// CM = uS / _DIV_CONST
|
||||||
@@ -41,9 +41,9 @@ extern volatile int16_t sonar_result;
|
|||||||
// Create a Sonar port
|
// Create a Sonar port
|
||||||
// Args: sonar_t* so, Trig pin, Echo pin
|
// Args: sonar_t* so, Trig pin, Echo pin
|
||||||
#define sonar_init(so, trig, echo) do { \
|
#define sonar_init(so, trig, echo) do { \
|
||||||
as_output(io_pack(trig)); \
|
as_output(trig); \
|
||||||
as_input_pu(io_pack(echo)); \
|
as_input_pu(echo); \
|
||||||
_sonar_init_do(so, &io2port(io_pack(trig)), io2n(io_pack(trig)), &io2pin(io_pack(echo)), io2n(io_pack(echo))); \
|
_sonar_init_do(so, &_port(trig), _pn(trig), &_pin(echo), _pn(echo)); \
|
||||||
} while(0)
|
} while(0)
|
||||||
|
|
||||||
// private, in header because of the macro.
|
// private, in header because of the macro.
|
||||||
|
|||||||
+4
-2
@@ -12,16 +12,18 @@ static char tmpstr[20]; // buffer for number rendering
|
|||||||
void put_str(const STREAM *p, char* str)
|
void put_str(const STREAM *p, char* str)
|
||||||
{
|
{
|
||||||
char c;
|
char c;
|
||||||
while ((c = *str++))
|
while ((c = *str++)) {
|
||||||
p->tx(c);
|
p->tx(c);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
void put_str_P(const STREAM *p, const char* str)
|
void put_str_P(const STREAM *p, const char* str)
|
||||||
{
|
{
|
||||||
char c;
|
char c;
|
||||||
while ((c = pgm_read_byte(str++)))
|
while ((c = pgm_read_byte(str++))) {
|
||||||
p->tx(c);
|
p->tx(c);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
+6
-16
@@ -5,6 +5,7 @@
|
|||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
|
|
||||||
|
#include "calc.h"
|
||||||
#include "uart.h"
|
#include "uart.h"
|
||||||
#include "stream.h"
|
#include "stream.h"
|
||||||
|
|
||||||
@@ -34,33 +35,21 @@ void _uart_init_do(uint16_t ubrr) {
|
|||||||
/** Enable or disable RX ISR */
|
/** Enable or disable RX ISR */
|
||||||
void uart_isr_rx(bool yes)
|
void uart_isr_rx(bool yes)
|
||||||
{
|
{
|
||||||
if(yes) {
|
set_bit(UCSR0B, RXCIE0, yes);
|
||||||
UCSR0B |= (1 << RXCIE0);
|
|
||||||
} else {
|
|
||||||
UCSR0B &= ~(1 << RXCIE0);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/** Enable or disable TX ISR (1 byte is sent) */
|
/** Enable or disable TX ISR (1 byte is sent) */
|
||||||
void uart_isr_tx(bool yes)
|
void uart_isr_tx(bool yes)
|
||||||
{
|
{
|
||||||
if(yes) {
|
set_bit(UCSR0B, TXCIE0, yes);
|
||||||
UCSR0B |= (1 << TXCIE0);
|
|
||||||
} else {
|
|
||||||
UCSR0B &= ~(1 << TXCIE0);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/** Enable or disable DRE ISR (all is sent) */
|
/** Enable or disable DRE ISR (all is sent) */
|
||||||
void uart_isr_dre(bool yes)
|
void uart_isr_dre(bool yes)
|
||||||
{
|
{
|
||||||
if(yes) {
|
set_bit(UCSR0B, UDRIE0, yes);
|
||||||
UCSR0B |= (1 << UDRIE0);
|
|
||||||
} else {
|
|
||||||
UCSR0B &= ~(1 << UDRIE0);
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@@ -107,6 +96,7 @@ void uart_puts_P(const char* str)
|
|||||||
void uart_flush()
|
void uart_flush()
|
||||||
{
|
{
|
||||||
uint8_t dummy;
|
uint8_t dummy;
|
||||||
while (UCSR0A & (1 << RXC0))
|
while (bit_is_high(UCSR0A, RXC0)) {
|
||||||
dummy = UDR0;
|
dummy = UDR0;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
+23
-23
@@ -18,7 +18,7 @@
|
|||||||
|
|
||||||
#include <avr/io.h>
|
#include <avr/io.h>
|
||||||
|
|
||||||
#include "pins.h"
|
#include "iopins.h"
|
||||||
#include "nsdelay.h"
|
#include "nsdelay.h"
|
||||||
#include "colors.h"
|
#include "colors.h"
|
||||||
|
|
||||||
@@ -55,11 +55,11 @@
|
|||||||
#define ws_send_byte(io, bb) do { \
|
#define ws_send_byte(io, bb) do { \
|
||||||
for (volatile int8_t __ws_tmp = 7; __ws_tmp >= 0; --__ws_tmp) { \
|
for (volatile int8_t __ws_tmp = 7; __ws_tmp >= 0; --__ws_tmp) { \
|
||||||
if ((bb) & (1 << __ws_tmp)) { \
|
if ((bb) & (1 << __ws_tmp)) { \
|
||||||
pin_high(io_pack(io)); delay_ns_c(WS_T_1H, -2); \
|
set_high(io); delay_ns_c(WS_T_1H, -2); \
|
||||||
pin_low(io_pack(io)); delay_ns_c(WS_T_1L, -10); \
|
set_low(io); delay_ns_c(WS_T_1L, -10); \
|
||||||
} else { \
|
} else { \
|
||||||
pin_high(io_pack(io)); delay_ns_c(WS_T_0H, -2); \
|
set_high(io); delay_ns_c(WS_T_0H, -2); \
|
||||||
pin_low(io_pack(io)); delay_ns_c(WS_T_0L, -10); \
|
set_low(io); delay_ns_c(WS_T_0L, -10); \
|
||||||
} \
|
} \
|
||||||
} \
|
} \
|
||||||
} while(0)
|
} while(0)
|
||||||
@@ -67,32 +67,32 @@
|
|||||||
|
|
||||||
/** Send R,G,B color to the strip */
|
/** Send R,G,B color to the strip */
|
||||||
#define ws_send_rgb(io, r, g, b) do { \
|
#define ws_send_rgb(io, r, g, b) do { \
|
||||||
ws_send_byte(io_pack(io), g); \
|
ws_send_byte(io, g); \
|
||||||
ws_send_byte(io_pack(io), r); \
|
ws_send_byte(io, r); \
|
||||||
ws_send_byte(io_pack(io), b); \
|
ws_send_byte(io, b); \
|
||||||
} while(0)
|
} while(0)
|
||||||
|
|
||||||
/** Send a RGB struct */
|
/** Send a RGB struct */
|
||||||
#define ws_send_xrgb(io, xrgb) ws_send_rgb(io_pack(io), (xrgb).r, (xrgb).g, (xrgb).b)
|
#define ws_send_xrgb(io, xrgb) ws_send_rgb(io, (xrgb).r, (xrgb).g, (xrgb).b)
|
||||||
|
|
||||||
/** Send color hex */
|
/** Send color hex */
|
||||||
#define ws_send_rgb24(io, rgb) ws_send_rgb(io_pack(io), rgb24_r(rgb), rgb24_g(rgb), rgb24_b(rgb))
|
#define ws_send_rgb24(io, rgb) ws_send_rgb(io, rgb24_r(rgb), rgb24_g(rgb), rgb24_b(rgb))
|
||||||
#define ws_send_rgb15(io, rgb) ws_send_rgb(io_pack(io), rgb15_r(rgb), rgb15_g(rgb), rgb15_b(rgb))
|
#define ws_send_rgb15(io, rgb) ws_send_rgb(io, rgb15_r(rgb), rgb15_g(rgb), rgb15_b(rgb))
|
||||||
#define ws_send_rgb12(io, rgb) ws_send_rgb(io_pack(io), rgb12_r(rgb), rgb12_g(rgb), rgb12_b(rgb))
|
#define ws_send_rgb12(io, rgb) ws_send_rgb(io, rgb12_r(rgb), rgb12_g(rgb), rgb12_b(rgb))
|
||||||
#define ws_send_rgb6(io, rgb) ws_send_rgb(io_pack(io), rgb6_r(rgb), rgb6_g(rgb), rgb6_b(rgb))
|
#define ws_send_rgb6(io, rgb) ws_send_rgb(io, rgb6_r(rgb), rgb6_g(rgb), rgb6_b(rgb))
|
||||||
|
|
||||||
/** Send array of colors */
|
/** Send array of colors */
|
||||||
#define ws_send_xrgb_array(io, rgbs, length) __ws_send_array_proto(io_pack(io), (rgbs), (length), xrgb)
|
#define ws_send_xrgb_array(io, rgbs, length) __ws_send_array_proto(io, (rgbs), (length), xrgb)
|
||||||
#define ws_send_rgb24_array(io, rgbs, length) __ws_send_array_proto(io_pack(io), (rgbs), (length), rgb24)
|
#define ws_send_rgb24_array(io, rgbs, length) __ws_send_array_proto(io, (rgbs), (length), rgb24)
|
||||||
#define ws_send_rgb15_array(io, rgbs, length) __ws_send_array_proto(io_pack(io), (rgbs), (length), rgb15)
|
#define ws_send_rgb15_array(io, rgbs, length) __ws_send_array_proto(io, (rgbs), (length), rgb15)
|
||||||
#define ws_send_rgb12_array(io, rgbs, length) __ws_send_array_proto(io_pack(io), (rgbs), (length), rgb12)
|
#define ws_send_rgb12_array(io, rgbs, length) __ws_send_array_proto(io, (rgbs), (length), rgb12)
|
||||||
#define ws_send_rgb6_array(io, rgbs, length) __ws_send_array_proto(io_pack(io), (rgbs), (length), rgb6)
|
#define ws_send_rgb6_array(io, rgbs, length) __ws_send_array_proto(io, (rgbs), (length), rgb6)
|
||||||
|
|
||||||
// prototype for sending array. it's ugly, sorry.
|
// prototype for sending array. it's ugly, sorry.
|
||||||
#define __ws_send_array_proto(io, rgbs, length, style) do { \
|
#define __ws_send_array_proto(io, rgbs, length, style) do { \
|
||||||
for (uint8_t __ws_sap_i = 0; __ws_sap_i < length; __ws_sap_i++) { \
|
for (uint8_t __ws_sap_i = 0; __ws_sap_i < length; __ws_sap_i++) { \
|
||||||
style ## _t __ws_sap2 = (rgbs)[__ws_sap_i]; \
|
style ## _t __ws_sap2 = (rgbs)[__ws_sap_i]; \
|
||||||
ws_send_ ## style(io_pack(io), __ws_sap2); \
|
ws_send_ ## style(io, __ws_sap2); \
|
||||||
} \
|
} \
|
||||||
} while(0)
|
} while(0)
|
||||||
|
|
||||||
@@ -101,11 +101,11 @@
|
|||||||
int8_t __ws_sxaz_y, __ws_sxaz_x; \
|
int8_t __ws_sxaz_y, __ws_sxaz_x; \
|
||||||
for(__ws_sxaz_y = 0; __ws_sxaz_y < (height); __ws_sxaz_y ++) { \
|
for(__ws_sxaz_y = 0; __ws_sxaz_y < (height); __ws_sxaz_y ++) { \
|
||||||
for(__ws_sxaz_x = 0; __ws_sxaz_x < (width); __ws_sxaz_x++) { \
|
for(__ws_sxaz_x = 0; __ws_sxaz_x < (width); __ws_sxaz_x++) { \
|
||||||
ws_send_xrgb(io_pack(io), (rgbs)[__ws_sxaz_y][__ws_sxaz_x]); \
|
ws_send_xrgb(io, (rgbs)[__ws_sxaz_y][__ws_sxaz_x]); \
|
||||||
} \
|
} \
|
||||||
__ws_sxaz_y++; \
|
__ws_sxaz_y++; \
|
||||||
for(__ws_sxaz_x = (width) - 1; __ws_sxaz_x >= 0; __ws_sxaz_x--) { \
|
for(__ws_sxaz_x = (width) - 1; __ws_sxaz_x >= 0; __ws_sxaz_x--) { \
|
||||||
ws_send_xrgb(io_pack(io), (rgbs)[__ws_sxaz_y][__ws_sxaz_x]); \
|
ws_send_xrgb(io, (rgbs)[__ws_sxaz_y][__ws_sxaz_x]); \
|
||||||
} \
|
} \
|
||||||
} \
|
} \
|
||||||
} while(0)
|
} while(0)
|
||||||
@@ -116,11 +116,11 @@
|
|||||||
int8_t __ws_sxazl_x, __ws_sxazl_y; \
|
int8_t __ws_sxazl_x, __ws_sxazl_y; \
|
||||||
for(__ws_sxazl_y = 0; __ws_sxazl_y < (height); __ws_sxazl_y++) { \
|
for(__ws_sxazl_y = 0; __ws_sxazl_y < (height); __ws_sxazl_y++) { \
|
||||||
for(__ws_sxazl_x = 0; __ws_sxazl_x < (width); __ws_sxazl_x++) { \
|
for(__ws_sxazl_x = 0; __ws_sxazl_x < (width); __ws_sxazl_x++) { \
|
||||||
ws_send_xrgb(io_pack(io), (rgbs)[__ws_sxazl_y * (width) + __ws_sxazl_x]); \
|
ws_send_xrgb(io, (rgbs)[__ws_sxazl_y * (width) + __ws_sxazl_x]); \
|
||||||
} \
|
} \
|
||||||
__ws_sxazl_y++; \
|
__ws_sxazl_y++; \
|
||||||
for(__ws_sxazl_x = width-1; __ws_sxazl_x >=0; __ws_sxazl_x--) { \
|
for(__ws_sxazl_x = width-1; __ws_sxazl_x >=0; __ws_sxazl_x--) { \
|
||||||
ws_send_xrgb(io_pack(io), (rgbs)[__ws_sxazl_y * (width) + __ws_sxazl_x]); \
|
ws_send_xrgb(io, (rgbs)[__ws_sxazl_y * (width) + __ws_sxazl_x]); \
|
||||||
} \
|
} \
|
||||||
} \
|
} \
|
||||||
} while(0)
|
} while(0)
|
||||||
|
|||||||
Reference in New Issue
Block a user