Statistics
| Revision:

root / branches / colonetmk2 / code / projects / libdragonfly / dragonfly_lib.c @ 1456

History | View | Annotate | Download (3.65 KB)

1
/**
2
 * Copyright (c) 2007 Colony Project
3
 * 
4
 * Permission is hereby granted, free of charge, to any person
5
 * obtaining a copy of this software and associated documentation
6
 * files (the "Software"), to deal in the Software without
7
 * restriction, including without limitation the rights to use,
8
 * copy, modify, merge, publish, distribute, sublicense, and/or sell
9
 * copies of the Software, and to permit persons to whom the
10
 * Software is furnished to do so, subject to the following
11
 * conditions:
12
 * 
13
 * The above copyright notice and this permission notice shall be
14
 * included in all copies or substantial portions of the Software.
15
 * 
16
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
17
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
18
 * OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
19
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
20
 * HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
21
 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
22
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
23
 * OTHER DEALINGS IN THE SOFTWARE.
24
 **/
25

    
26

    
27
/**
28
 * @file dragonfly_lib.c
29
 * @brief Dragonfly initialization
30
 *
31
 * Contains implementation of dragonfly_init.
32
 *
33
 * @author Colony Project, CMU Robotics Club
34
 **/
35

    
36
#include "dragonfly_lib.h"
37

    
38
/* init_dragonfly - Initializes functions based on configuration parameters
39
   examples:
40

41
   init_dragonfly (0, 0, 0); - just initialize the digital IO (buttons, potentiometer)
42

43
   init_dragonfly (ANALOG | SERIAL | BUZZER, C0_C1_ANALOG, BAUD115200); 
44
   Initialize ADC and set C0 and C1 as analog inputs.  Initialize serial and set baud rate
45
   to 115200 bps.  Initialize the buzzer.
46
   
47
   init_dragonfly (MOTORS | ORB, 0, 0);
48
   Initialize motor driving and the color fading abilities of the ORB. */
49

    
50
/**
51
 * @defgroup dragonfly Dragonfly
52
 * @brief General Dragonfly Functions
53
 * General functions for the dragonfly. Include
54
 * dragonfly_lib.h to access these functions.
55
 *
56
 * @{
57
 **/
58

    
59
/**
60
 * Initializes the components specified by config.
61
 * 
62
 * @see analog_init, usb_init, xbee_init, buzzer_init,
63
 * bom_init, orb_init, motors_init, lcd_init, encoders_init
64
 **/
65
 
66
void flash_red(void);
67

    
68
void dragonfly_init(int config) 
69
{
70
    sei();
71
    // Set directionality of various IO pins
72
    DDRG &= ~(_BV(PING0)|_BV(PING1));
73
    PORTG |= _BV(PING0)|_BV(PING1);
74
    
75
    if(config & ANALOG)
76
        analog_init(ADC_START);
77
    
78
    if(config & COMM)
79
    {
80
        //Defaults to 115200. Check serial.h for more information.
81
        usb_init();
82
        xbee_init();
83
    }
84
    
85
    if(config & BUZZER)
86
    {
87
        sei();
88
        buzzer_init();
89
    }
90
    
91
    if(config & ORB)
92
    {
93
        sei();
94
        orb_init();
95
    }
96
    
97
    if(config & MOTORS)
98
        motors_init();
99

    
100
    if(config & LCD)
101
        lcd_init();
102
    
103
    if(config & RANGE)
104
        range_init();
105
        
106
    if(config & BOM)
107
    {
108
        unsigned char bom_read = get_bom_type();
109
        if(bom_read == 0xFF)
110
            //warn that bom initialization failed
111
            flash_red();
112
        else
113
            bom_init(bom_read);
114
    }
115

    
116
        if (config & ENCODERS)
117
        {
118
                encoders_init();
119
        }
120

    
121
    // delay a bit for stability
122
    _delay_ms(1);
123
}
124

    
125
//flash lights red three times and restore ports
126
void flash_red(void)
127
{
128
    cli();
129
    char dd = DDRC;
130
    char po = PORTC;
131
    char i;
132
    DDRC = 0x77;
133
    for(i = 0; i<3; i++)
134
    {
135
        PORTC = 0x77;
136
        delay_ms(300);
137
        PORTC = 0x66;
138
        delay_ms(300);
139
    }
140
    
141
    DDRC = dd;
142
    PORTC = po;
143
    sei();
144
}
145
/** @} **/ //end defgroup
146