Subversion Repositories HomeAutomation

Rev

Details | Last modification | View Log | SVN | RSS feed

Rev Author Line No. Line
330 noddan 1
/**
2
 * CAN RGB LED. This application is used to control a RGB LED.
3
 * Still under heavy development
4
 *
5
 * @date    2007-02-10
6
 * @author  Martin Nordén
7
 *
8
 * Set RGB: <byte0 RGBLED_CMD_SETRGB> <byte 1 Set/Fade> <byte2 R> <byte3 G> <byte4 B>
9
 * Change RGB: <byte 0 RGBLED_CMD_CHANGERGB> <byte 1 int R> <byte 2 int G> <byte 3 int B>  (Note that they are all signed)
10
 * Set Intens: <byte0 RGBLED_CMD_SETINTENS> <byte1 Set/Fade> <byte2 Intens> (<byte3 dimSpeed>)
11
 *
12
 * TODO: Better CAN Integration, Failsafe mode, Tempsensors etc.
13
 */
14
 
15
 
16
/*-----------------------------------------------------------------------------
17
 * Includes
18
 *---------------------------------------------------------------------------*/
19
/* system files */
20
#include <avr/interrupt.h>
21
#include <inttypes.h>
22
#include <stdio.h>
23
#include <bios.h>
24
#include <avr/pgmspace.h> //To allow read/write from flash
25
 
26
/* lib files */
27
//#include <can.h>
28
//#include <serial.h>
29
//#include <timebase.h>
30
//#include <math.h> //Not sure this is needed anymore..
31
 
32
/*----------------------------------------------------------------------------
33
 * Defines
34
 * -------------------------------------------------------------------------*/
35
 
36
//Not implemented yet. Will be implementet when I build a canUSB :)
37
 
38
#define RGBLED_CMD_GET      0x1400
39
#define RGBLED_CMD_SEND     0x1401
40
 
41
#define RGBLED_CMD_STATUS       0x00    /* Get status */
42
#define RGBLED_CMD_SETRGB       0x01    /* Set RGB Triplet */
43
#define RGBLED_CMD_CHANGERGB  0x02  /* Change RGB +/- */
44
#define RGBLED_CMD_SETINTENS  0x10  /* Set intensity */
45
 
46
/*----------------------------------------------------------------------------
47
 * Ehm, struct?
48
 * -------------------------------------------------------------------------*/
49
typedef struct
50
{
51
    uint8_t R;
52
    uint8_t G;
53
    uint8_t B;
54
    uint8_t Intens;
55
} Color;
56
 
57
/*-----------------------------------------------------------------------------
58
 * Programs! There will be a better way to add programs here.. some day.
59
 *---------------------------------------------------------------------------*/
60
 
61
//Special combinations that means something special
62
//The combinations are useless for lighting anyway
63
//So we might as well use them!
64
//0x00, 0x00, 0x00, 0x00 means end of program, keep looping it
65
//0x00, 0x00, 0x00, 0x01 means end of program, halt 
66
 
67
Color pgm1[] PROGMEM = {
68
{0xff,0x00,0x00,0x64},
69
{0xff,0xff,0x00,0x10},
70
{0x00,0xff,0x00,0xa0},
71
{0x00,0xff,0xff,0x7f},
72
{0x00,0x00,0xff,0x7f},
73
{0xff,0x00,0xff,0x40},
74
{0x00,0x00,0x00,0x00}
75
};
76
 
77
Color pgm2[] PROGMEM = {
78
{0xff,0x00,0x00,0x00},
79
{0xff,0xff,0x00,0x00},
80
{0xff,0xff,0xff,0x00},
81
{0xa0,0x00,0xa0,0x00},
82
{0x00,0x00,0xff,0x00},
83
{0x00,0x00,0x00,0x00}
84
};
85
 
86
Color pgm3[] PROGMEM = {
87
{0xff,0xff,0xff,0x00},
88
{0x00,0x00,0x00,0x01}
89
};
90
 
91
Color* programs[] PROGMEM = {
92
(Color*)pgm1,
93
(Color*)pgm2,
94
(Color*)pgm3
95
};
96
 
97
 
98
 
99
/*-----------------------------------------------------------------------------
100
 * Variables
101
 *---------------------------------------------------------------------------*/
102
uint32_t timeStamp; //TimeStamp to keep track of time
103
uint32_t dimStamp;  //Timestamp to keep track of dimmer changes
104
uint32_t time;      //Temptime for converting (TODO)
105
 
106
Color currColor;    //Current color
107
Color destColor;    //Destination color
108
 
109
uint16_t fadeSpeed; //Fadingspeed. 16bit for reaaaally slow fading. Sets the speed of colorchange.
110
uint8_t dimSpeed;       //Dimmer speed. Sets the speed of intensitychange.
111
 
112
uint8_t currProgram;    //This variable keeps track of what program is currently running. 
113
uint8_t programMode;    //This keeps track of what mode we are currently using. 0: the program obeyes the current brightness, 1: the program is allowed to set it's own brightness
114
 
115
/*----------------------------------------------------------------------------
116
 * Functions
117
 * -------------------------------------------------------------------------*/
118
void updateLED();
119
void reformatRGB(uint8_t R, uint8_t G, uint8_t B, uint8_t setBright);
120
void changeColor(int8_t amount, uint8_t* color);
121
void fade(uint8_t* current, uint8_t* destination);
122
 
123
 
124
void can_receive(Can_Message_t *msg) {
125
    //What should we do when can recieve?
126
}
127
 
128
/*-----------------------------------------------------------------------------
129
 * Main Program
130
 *---------------------------------------------------------------------------*/
131
int main(void) {
132
//  Timebase_Init();
133
//  Serial_Init();
134
//  Can_Init();
135
 
136
//Setting up OC1A, 16 bit counter used as 8 bit.
137
    TCCR1A |= (1<<COM1A1) | (1<<WGM11); /* Set OC1A at TOP, mode 14 */
138
    TCCR1B |= (1<<WGM13) | (1<<WGM12) | (1<<CS12); /* Timer uses main system clock with ? prescale */
139
    ICR1 = 256; //8 bit precision to match the other two counters.
140
    OCR1A = 0;  //0% as standard
141
    DDRB |= (1<<PB1); /* Enable pin as output */
142
//Setting up OC0A
143
    TCCR0A |= (1<<COM0A1)|(1<<WGM01)|(1<<WGM00); /* Set OC0A at TOP, Mode 7 */
144
    TCCR0B |= (1<<CS02); /* Prescaler updating now */
145
    OCR0A = 0;  //0% standard
146
    DDRD |= (1<<PD6);
147
//Setting up OC0B
148
    TCCR0A |= (1<<COM0B1);
149
    OCR0B = 0;
150
    DDRD |= (1<<PD5);
151
 
152
//Initialize variables
153
    fadeSpeed = 10;
154
    dimSpeed = 10;
155
    timeStamp = 0;
156
    dimStamp = 0;
157
//  Can_Message_t rxMsg;    
158
 
159
    reformatRGB(0x00,0xff,0x00,1);
160
    destColor.Intens = 100;
161
    currColor = destColor;
162
 
163
//Just temporary for now, they keep track of some kind of demo-program.
164
    currProgram = 1;
165
    programMode = 0;
166
    uint16_t temp_adress = pgm_read_word(&programs[currProgram-1]); //Get adress for program 0
167
 
168
    sei();
169
 
170
    bios->can_callback = &can_receive;
171
 
172
//Lets send out that we're alive
173
    Can_Message_t txMsg;
174
    txMsg.Id = 0x42; //booted!
175
    txMsg.DataLength = 4;
176
    txMsg.RemoteFlag = 0;
177
    txMsg.ExtendedFlag = 1;
178
    txMsg.Data.words[0] = 0x13;
179
    txMsg.Data.words[1] = 0x13;
180
    bios->can_send(&txMsg);
181
//Data sent.
182
 
183
//Just temporary
184
//  currColor.R = 0;
185
//  destColor.R = 100;
186
 
187
 
188
    /* main loop */
189
    while (1) {
190
 
191
        /* Time to fade color? */
192
        time = bios->timebase_get();
193
        if ((time - timeStamp) >= fadeSpeed) {
194
            fade(&currColor.R, &destColor.R);          
195
            fade(&currColor.G, &destColor.G);
196
            fade(&currColor.B, &destColor.B);
197
 
198
            timeStamp = bios->timebase_get();
199
            updateLED();
200
        }
201
 
202
 
203
        /* Time to fade intensity? */
204
//      if (Timebase_PassedTimeMillis(dimStamp) >= dimSpeed) {
205
//          fade(&currColor.Intens, &destColor.Intens);
206
//          dimStamp = Timebase_CurrentTime();
207
//          updateLED();
208
//      }
209
 
210
 
211
        /* Program management */
212
        if (currProgram != 0) { //Check if a program is currently running
213
            if ((currColor.R == destColor.R)&(currColor.G == destColor.G)&(currColor.B == destColor.B)&(currColor.Intens == destColor.Intens)){//Is the current sequence finished?
214
                //Now we have to check if the program is finished and if we should loop
215
                if ((pgm_read_byte(temp_adress)==0)&(pgm_read_byte(temp_adress+1)==0)&(pgm_read_byte(temp_adress+2)==0)){
216
                    //The program has ended! Shall we loop it?
217
                    if (pgm_read_byte(temp_adress+3)==0){
218
                        //Yes, let's loop it
219
                        temp_adress = pgm_read_word(&programs[currProgram-1]);
220
                    } else {
221
                        //No, halt!
222
                        currProgram = 0;
223
                    }
224
                } else {
225
                    //The program has not ended, let's get the next RGB-triplet!
226
                    destColor.R = pgm_read_byte(temp_adress);
227
                    destColor.G = pgm_read_byte(temp_adress + 1);
228
                    destColor.B = pgm_read_byte(temp_adress + 2);
229
                    if (programMode == 1){
230
                        destColor.Intens = pgm_read_byte(temp_adress + 3);
231
                    }
232
 
233
                    temp_adress = temp_adress + 4;             
234
                }
235
 
236
            }
237
 
238
        }
239
 
240
    }
241
 
242
    return 0;
243
}
244
 
245
 
246
 
247
 
248
/************************************************************************************************
249
 *     updateLED updates the PWM counter values and thus changes the color of the RGBLED.       *
250
 *     It doesn't reculculate anything, except the values to write to the PWM registers.        *
251
 *     TODO: Get rid of the tempcontainer!                                  *
252
 ************************************************************************************************/
253
void updateLED(){
254
    uint8_t tempcontainer;
255
 
256
    tempcontainer = currColor.R * currColor.Intens / 255;   //I really want to skip this, don't know how yet though.
257
    OCR1A = tempcontainer; 
258
      OCR0A = currColor.G * currColor.Intens / 255;
259
    OCR0B = currColor.B * currColor.Intens / 255;      
260
 
261
 
262
    //Bara för debugcrap
263
    Can_Message_t txMsg;
264
    txMsg.Id = 0x55;
265
    txMsg.RemoteFlag = 0;
266
    txMsg.ExtendedFlag = 1;
267
    txMsg.DataLength = 4;
268
    txMsg.Data.bytes[0] = currColor.R;
269
    txMsg.Data.bytes[1] = currColor.G;
270
    txMsg.Data.bytes[2] = currColor.B;
271
    txMsg.Data.bytes[3] = currColor.Intens;
272
 
273
    bios->can_send(&txMsg);
274
 
275
}
276
 
277
 
278
 
279
/************************************************************************************************
280
 *     reformatRGB sets a new target RGB triplet to fade to. It reformats it so that            *
281
 *     the highest color always gets 0xff. Brightness is recalculated.                          *
282
 *     if setBright is set to 0, the brightness will not be updated.                    *
283
 *     TODO: Smarter 16-bit arithmetics would be nice. Also a pointer to struct to be updated.  *
284
 ************************************************************************************************/
285
void reformatRGB(uint8_t R, uint8_t G, uint8_t B, uint8_t setBright){
286
    uint8_t maxvalue;
287
    uint16_t tempcontainer;
288
 
289
    if ((R>=G)&(R>=B)){
290
        maxvalue = R;
291
    } else if ((G>=R)&(G>=B)){
292
        maxvalue = G;
293
    } else {
294
        maxvalue = B;
295
    }
296
 
297
    tempcontainer = R * 255;
298
    destColor.R = tempcontainer/maxvalue;
299
    tempcontainer = G * 255;
300
    destColor.G = tempcontainer/maxvalue;
301
    tempcontainer = B * 255;
302
    destColor.B = tempcontainer/maxvalue;
303
 
304
    if (setBright){
305
        destColor.Intens = maxvalue;
306
    }
307
}
308
 
309
 
310
/************************************************************************************************
311
 *     fade takes two pointers, current and destination and fades current               *
312
 *     one tick closer to destination.                                                        *
313
 ************************************************************************************************/
314
void fade(uint8_t* current, uint8_t* destination){
315
    if (*current > *destination){
316
        *current = *current - 1;
317
    } else if (*current < *destination){
318
        *current = *current + 1;
319
    }
320
}
321
 
322
 
323
/************************************************************************************************
324
 *     changeColor changes a color accord to amount. -127>127.                                  *
325
 *     color is either dest och curr R,G,B.                                                     *
326
 *     Maybe TODO: If red is already 255 and we want to increase it, decrease the other ones.   *
327
 ************************************************************************************************/
328
void changeColor(int8_t amount, uint8_t* color){
329
    if ( ((amount > 0)&(*color < 255)) || ((amount < 0)&(*color > 0)) ) //Se till att vi inte slĺr över *color
330
    *color = *color + amount;
331
}