Colony

/**

 * Copyright (c) 2007 Colony Project

 * 

 * Permission is hereby granted, free of charge, to any person

 * obtaining a copy of this software and associated documentation

 * files (the "Software"), to deal in the Software without

 * restriction, including without limitation the rights to use,

 * copy, modify, merge, publish, distribute, sublicense, and/or sell

 * copies of the Software, and to permit persons to whom the

 * Software is furnished to do so, subject to the following

 * conditions:

 * 

 * The above copyright notice and this permission notice shall be

 * included in all copies or substantial portions of the Software.

 * 

 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,

 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES

 * OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND

 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT

 * HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,

 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING

 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR

 * OTHER DEALINGS IN THE SOFTWARE.

 **/

/**

 * @file dio.c

 * @brief Digital Input and Output

 *

 * Implementation of functions for digital input and output.

 *

 * @author Colony Project, CMU Robotics Club

 **/

#include <avr/interrupt.h>

#include <dio.h>

#include <time.h>

#include <lights.h>

int digital_input(int portpin) {

  int pin = portpin & 0x7;

  int pin_val = 0;

  switch(portpin >> 3) {

  case _PORT_A:

    DDRA &= ~_BV(pin);

    pin_val = PINA;

    return (pin_val >> pin) & 1;

  case _PORT_B:

    DDRB &= ~_BV(pin);

    pin_val = PINB;

    return (pin_val >> pin) & 1;

  case _PORT_C:

    DDRC &= ~_BV(pin);

    pin_val = PINC;

    return (pin_val >> pin) & 1;

  case _PORT_D:

    DDRD &= ~_BV(pin);

    pin_val = PIND;

    return (pin_val >> pin) & 1;

  case _PORT_E:

    DDRE &= ~_BV(pin);

    pin_val = PINE;

    return (pin_val >> pin) & 1;

  case _PORT_F:

    if(pin>=4) {

      MCUSR|=1<<7;

      MCUSR|=1<<7;

    }

    DDRF &= ~_BV(pin);

    pin_val = PINF;

    return (pin_val >> pin) & 1;

  case _PORT_G:

    DDRG &= ~_BV(pin);

    pin_val = PING;

    return (pin_val >> pin) & 1;

  default: break;

  }

  return -1;

}

void digital_pull_up(int portpin) {

  int pins = portpin & 0x07;

  switch(portpin >> 3) {

  case _PORT_A:

    PORTA |= _BV(pins);

    break;

  case _PORT_B:

    PORTB |= _BV(pins);

    break;    

  case _PORT_C:

    PORTC |= _BV(pins);

    break;    

  case _PORT_D:

    PORTD |= _BV(pins);

    break;    

  case _PORT_E:

    PORTE |= _BV(pins);

    break;    

  case _PORT_F:

    PORTF |= _BV(pins);

    break;    

  case _PORT_G:

    PORTG |= _BV(pins);

    break;

  }

}

void digital_output(int portpin, int val) {

  int pins = portpin & 0x07;

  /* if you want to set to 0... */

  if(val == 0) {

    switch(portpin >> 3) {

    case _PORT_A:

      DDRA |= _BV(pins);

      PORTA &= (0XFF - _BV(pins));

      break;

    case _PORT_B:

      DDRB |= _BV(pins);

      PORTB &= (0XFF - _BV(pins));

      break;    

    case _PORT_C:

      DDRC |= _BV(pins);

      PORTC &= (0XFF - _BV(pins));

      break;    

    case _PORT_D:

      DDRD |= _BV(pins);

      PORTD &= (0XFF - _BV(pins));

      break;    

    case _PORT_E:

      DDRE |= _BV(pins);

      PORTE &= (0XFF - _BV(pins));

      break;    

    case _PORT_F:

      DDRF |= _BV(pins);

      PORTF &= (0XFF - _BV(pins));

      break;    

    case _PORT_G:

      DDRG |= _BV(pins);

      PORTG &= (0XFF - _BV(pins));

      break;

    }

  } else { /* ( val == 1) */ 

    switch(portpin >> 3) {

    case _PORT_A:

      DDRA |= _BV(pins);

      PORTA |= _BV(pins);

      break;

    case _PORT_B:

      DDRB |= _BV(pins);

      PORTB |= _BV(pins);

      break;    

    case _PORT_C:

      DDRC |= _BV(pins);

      PORTC |= _BV(pins);

      break;    

    case _PORT_D:

      DDRD |= _BV(pins);

      PORTD |= _BV(pins);

      break;    

    case _PORT_E:

      DDRE |= _BV(pins);

      PORTE |= _BV(pins);

      break;    

    case _PORT_F:

      DDRF |= _BV(pins);

      PORTF |= _BV(pins);

      break;    

    case _PORT_G:

      DDRG |= _BV(pins);

      PORTG |= _BV(pins);

      break;

    }

  }

}

int button1_read( void ) {

  int pin_val;

  DDRG &= ~_BV(PING0);

  PORTG|= _BV(PING0);

  pin_val = PING;

  return !((pin_val & _BV(PING0)));

}

void button1_wait( void ) {

  while(!button1_read() ) {

    delay_ms(15);

  }

}

int button1_click() {

  if(button1_read()) {

    while(button1_read());

    return 1;

  } else {

    return 0;

  }

}

int button2_read( void ) {

  int pin_val;

  DDRG &= ~_BV(PING1);

  PORTG|= _BV(PING1);

  pin_val = PING;

  return !((pin_val & _BV(PING1)));

}

void button2_wait( void ) {

  while(!button2_read()){

    delay_ms(15);

  }

}

int button2_click() {

  if(button2_read()) {

    while(button2_read());

    return 1;

  } else {

    return 0;

  }

}