From 72ed993e982d1a2484ef9d54d93757f2f9094547 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Fri, 10 Apr 2009 01:16:50 +0200 Subject: * digital/dev2: - added usb_serial_isp, no isp yet. --- digital/dev2/src/common/select.c | 66 ++++++++++++++++++++++++++++++++++++++++ 1 file changed, 66 insertions(+) create mode 100644 digital/dev2/src/common/select.c (limited to 'digital/dev2/src/common/select.c') diff --git a/digital/dev2/src/common/select.c b/digital/dev2/src/common/select.c new file mode 100644 index 00000000..d4e7bb30 --- /dev/null +++ b/digital/dev2/src/common/select.c @@ -0,0 +1,66 @@ +/* select.c - Output selection mechanism. */ +/* dev2 - Multi-purpose development board using USB and Ethernet. {{{ + * + * Copyright (C) 2009 Nicolas Schodet + * + * APBTeam: + * Web: http://apbteam.org/ + * Email: team AT apbteam DOT org + * + * This program 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. + * + * 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, write to the Free Software + * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. + * + * }}} */ +#include "common.h" + +#include "io.h" + +#include "select.h" + +#define ENABLE _BV (2) +#define SELA _BV (5) +#define SELB _BV (4) + +/* Initialise selector. */ +void +select_init (void) +{ + PORTC &= ~(ENABLE | SELA | SELB); + DDRC |= ENABLE | SELA | SELB; +} + +/* Select an output (1-4) or switch off (0, anything else). */ +void +select_out (uint8_t num) +{ + uint8_t p = PORTC & ~(ENABLE | SELA | SELB); + switch (num) + { + case 1: + PORTC = p | ENABLE; + break; + case 2: + PORTC = p | ENABLE | SELA; + break; + case 3: + PORTC = p | ENABLE | SELB; + break; + case 4: + PORTC = p | ENABLE | SELA | SELB; + break; + default: + PORTC = p; + break; + } +} -- cgit v1.2.3