From c65e0ea6e387b39e115b6af28e79ba1418f605b2 Mon Sep 17 00:00:00 2001 From: Moritz Fischer Date: Mon, 13 Jul 2015 14:03:42 -0700 Subject: e3xx: Added firmware for battery based devices. Note: This firmware does *not* support Rev B units. Signed-off-by: Moritz Fischer --- firmware/e300/battery/io.c | 67 ++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 67 insertions(+) create mode 100644 firmware/e300/battery/io.c (limited to 'firmware/e300/battery/io.c') diff --git a/firmware/e300/battery/io.c b/firmware/e300/battery/io.c new file mode 100644 index 000000000..8bb393705 --- /dev/null +++ b/firmware/e300/battery/io.c @@ -0,0 +1,67 @@ +/* USRP E310 IO helpers +* Copyright (C) 2014 Ettus Research +* This file is part of the USRP E310 Firmware +* The USRP E310 Firmware 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 2 of the License, or +* (at your option) any later version. +* The USRP E310 Firmware 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 the USRP E310 Firmware. If not, see . +*/ + +#include + +#include "io.h" +#include "utils.h" + +#define _GET_PIN(pin) ((pin) & 0xf) +#define _GET_MASK(pin) (BIT(_GET_PIN(pin))) +#define _GET_REG(pin, reg_x) (*reg_x[pin >> 4]) + +static volatile uint8_t *ddr_x[] = {&DDRA, &DDRB, &DDRC, &DDRD}; +static volatile uint8_t *port_x[] = {&PORTA, &PORTB, &PORTC, &PORTD}; +static volatile uint8_t *pin_x[] = {&PINA, &PINB, &PINC, &PIND}; + +void io_output_pin(io_pin_t pin) +{ + _GET_REG(pin, ddr_x) |= _GET_MASK(pin); +} + +void io_input_pin(io_pin_t pin) +{ + _GET_REG(pin, ddr_x) &= ~_GET_MASK(pin); +} + +bool io_is_output(io_pin_t pin) +{ + return bit_is_set(_GET_REG(pin, ddr_x), _GET_PIN(pin)); +} + +bool io_is_input(io_pin_t pin) +{ + return !io_is_output(pin); +} + +void io_set_pin(io_pin_t pin) +{ + _GET_REG(pin, port_x) |= _GET_MASK(pin); +} + +void io_clear_pin(io_pin_t pin) +{ + _GET_REG(pin, port_x) &= ~_GET_MASK(pin); +} + +bool io_is_pin_set(io_pin_t pin) +{ + return bit_is_set(_GET_REG(pin, port_x), _GET_PIN(pin)); +} + +bool io_test_pin(io_pin_t pin) +{ + return bit_is_set(_GET_REG(pin, pin_x), _GET_PIN(pin)); +} -- cgit v1.2.3