1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
|
/*
* Copyright 2009-2012 Ettus Research LLC
*/
#include "io.h"
#include <avr/io.h>
#define _GET_PIN(pin) ((pin) & 0xf)
#define _GET_MASK(pin) (_BV(_GET_PIN(pin)))
#define _GET_REG(pin, reg_x) (*reg_x[pin >> 4])
#ifndef IO_DEBUG
static volatile uint8_t *ddr_x[] = {&DDRA, &DDRB, &DDRC, &DDRD}; // 0: input, 1: output
static volatile uint8_t *port_x[] = {&PORTA, &PORTB, &PORTC, &PORTD}; // Port contents (will appear at output if direction is set to output. If input, '1' enables pull-ups, '0' set tri-state)
static volatile uint8_t *pin_x[] = {&PINA, &PINB, &PINC, &PIND}; // Port contents (input) If output, will return value on PORT
#endif
void io_output_pin(io_pin_t pin){
#ifndef IO_DEBUG
_GET_REG(pin, ddr_x) |= _GET_MASK(pin);
#endif
}
void io_input_pin(io_pin_t pin){
#ifndef IO_DEBUG
_GET_REG(pin, ddr_x) &= ~_GET_MASK(pin);
#endif
}
bool io_is_output(io_pin_t pin){
#ifndef IO_DEBUG
return bit_is_set(_GET_REG(pin, ddr_x), _GET_PIN(pin));
#else
return 0;
#endif
}
bool io_is_input(io_pin_t pin){
return !io_is_output(pin);
}
void io_set_pin(io_pin_t pin){ // In input mode, will enable pull-ups
#ifndef IO_DEBUG
_GET_REG(pin, port_x) |= _GET_MASK(pin);
#endif
}
void io_clear_pin(io_pin_t pin){ // In input mode, will disable pull-ups
#ifndef IO_DEBUG
_GET_REG(pin, port_x) &= ~_GET_MASK(pin);
#endif
}
bool io_is_pin_set(io_pin_t pin){
#ifndef IO_DEBUG
return bit_is_set(_GET_REG(pin, port_x), _GET_PIN(pin));
#else
return 0;
#endif
}
void io_enable_pin(io_pin_t pin, bool enable){
if (enable)
io_set_pin(pin);
else
io_clear_pin(pin);
}
bool io_test_pin(io_pin_t pin){
#ifndef IO_DEBUG
return bit_is_set(_GET_REG(pin, pin_x), _GET_PIN(pin));
#else
return 0;
#endif
}
|
