Subversion Repositories HomeAutomation

Rev

Rev 129 | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | SVN | RSS feed

Rev 129 Rev 141
1
/*********************************************************************
1
/*********************************************************************
2
 *
2
 *
3
 *                  Main application
3
 *                  Main application
4
 *
4
 *
5
 *********************************************************************
5
 *********************************************************************
6
 * FileName:        $HeadURL: https://svn.auml.se/svn/HomeAutomation/trunk/EmbeddedSoftware/PIC/canFreezer/Source/Main.c $
6
 * FileName:        $HeadURL: https://svn.auml.se/svn/HomeAutomation/trunk/EmbeddedSoftware/PIC/canFreezer/Source/Main.c $
7
 * Last changed:    $LastChangedDate: 2006-11-20 17:54:03 +0100 (Mon, 20 Nov 2006) $
7
 * Last changed:    $LastChangedDate: 2006-11-21 10:57:15 +0100 (Tue, 21 Nov 2006) $
8
 * By:              $LastChangedBy: johboh $
8
 * By:              $LastChangedBy: johboh $
9
 * Revision:        $Revision: 129 $
9
 * Revision:        $Revision: 141 $
10
 ********************************************************************/
10
 ********************************************************************/
11
 
11
 
12
 
12
 
13
#include <compiler.h>
13
#include <compiler.h>
14
#include <stackTasks.h>
14
#include <stackTasks.h>
15
#include <Tick.h>
15
#include <Tick.h>
16
#include <funcdefs.h>
16
#include <funcdefs.h>
17
#include <EEaccess.h>
17
#include <EEaccess.h>
18
 
18
 
19
#ifdef USE_CAN
19
#ifdef USE_CAN
20
    #include <CAN.h>
20
    #include <CAN.h>
21
#endif
21
#endif
22
 
22
 
-
 
23
#ifdef USE_ADC
-
 
24
    #include <adc.h>
-
 
25
#endif
-
 
26
 
23
static void mainInit(void);
27
static void mainInit(void);
24
 
28
 
25
 
29
 
26
static int MY_ID = DEFAULT_ID;
30
static int MY_ID = DEFAULT_ID;
27
static BYTE MY_NID = DEFAULT_NID;
31
static BYTE MY_NID = DEFAULT_NID;
28
 
32
 
29
void main()
33
void main()
30
{
34
{
31
    static TICK t = 0;
35
    static TICK t = 0;
32
    CAN_MESSAGE outCm;
36
    CAN_MESSAGE outCm;
33
 
37
 
34
    // Inits
38
    // Inits
35
 
39
 
36
    mainInit();
40
    mainInit();
37
 
41
 
38
    #ifdef USE_CAN
42
    #ifdef USE_CAN
39
        canInit();
43
        canInit();
-
 
44
    #endif
-
 
45
 
-
 
46
    #ifdef USE_ADC
-
 
47
        adcInit(TRUE,0b1011);
40
    #endif
48
    #endif
41
 
49
 
42
    tickInit();
50
    tickInit();
43
 
51
 
44
    // Read ID and NID if exist.
52
    // Read ID and NID if exist.
45
    if (EERead(NODE_ID_EE)==NODE_HAS_ID)
53
    if (EERead(NODE_ID_EE)==NODE_HAS_ID)
46
    {
54
    {
47
        MY_ID=(((WORD)EERead(NODE_ID_EE + 1))<<8)+EERead(NODE_ID_EE + 2);
55
        MY_ID=(((WORD)EERead(NODE_ID_EE + 1))<<8)+EERead(NODE_ID_EE + 2);
48
        MY_NID=EERead(NODE_ID_EE + 3);
56
        MY_NID=EERead(NODE_ID_EE + 3);
49
    }
57
    }
50
 
58
 
51
    // Send user program startup heatbeat
59
    // Send user program startup heatbeat
52
    outCm.funct                     = FUNCT_BOOTLOADER;
60
    outCm.funct                     = FUNCT_BOOTLOADER;
53
    outCm.funcc                     = FUNCC_BOOT_HEARTBEAT;
61
    outCm.funcc                     = FUNCC_BOOT_HEARTBEAT;
54
    outCm.nid                       = MY_NID;
62
    outCm.nid                       = MY_NID;
55
    outCm.sid                       = MY_ID;
63
    outCm.sid                       = MY_ID;
56
    outCm.data_length               = 1;
64
    outCm.data_length               = 1;
57
    outCm.data[BOOT_DATA_HEARTBEAT_INDEX] = HEARTBEAT_USER_STARTUP;
65
    outCm.data[BOOT_DATA_HEARTBEAT_INDEX] = HEARTBEAT_USER_STARTUP;
58
    while(!canSendMessage(outCm,PRIO_HIGH));
66
    while(!canSendMessage(outCm,PRIO_HIGH));
59
 
67
 
60
 
68
 
61
    while(1)
69
    while(1)
62
    {
70
    {
63
        static TICK t = 0;
71
        static TICK t = 0;
64
        static TICK heartbeat = 0;
72
        static TICK heartbeat = 0;
-
 
73
        static TICK temperature = 0;
-
 
74
        static BYTE lastTemperature = TEMPERATURE_FREEZER;
-
 
75
        static BYTE lastFreezerDoor = DOOR_CLOSED;
-
 
76
        static BYTE lastRefrigeratorDoor = DOOR_CLOSED;
-
 
77
 
-
 
78
 
-
 
79
        //Poll doors freezer door
-
 
80
        if (lastFreezerDoor!=DOOR_FREEZER_IO)
-
 
81
        {  
-
 
82
            lastFreezerDoor=DOOR_FREEZER_IO;
-
 
83
            // Send door status change
-
 
84
            outCm.funct                     = FUNCT_SENSORS;
-
 
85
            outCm.funcc                     = FUNCC_SENSORS_DOORS_FREEZER;
-
 
86
            outCm.nid                       = MY_NID;
-
 
87
            outCm.sid                       = MY_ID;
-
 
88
            outCm.data_length               = 1;
-
 
89
            outCm.data[0]                   = (lastFreezerDoor==DOOR_OPEN?0:1);
-
 
90
            while(!canSendMessage(outCm,PRIO_HIGH));
-
 
91
        }
-
 
92
 
-
 
93
        //Poll doors refrigerator door
-
 
94
        if (lastRefrigeratorDoor!=DOOR_REFRIGERATOR_IO)
-
 
95
        {  
-
 
96
            lastRefrigeratorDoor=DOOR_REFRIGERATOR_IO;
-
 
97
            // Send door status change
-
 
98
            outCm.funct                     = FUNCT_SENSORS;
-
 
99
            outCm.funcc                     = FUNCC_SENSORS_DOORS_REFRIGERATOR;
-
 
100
            outCm.nid                       = MY_NID;
-
 
101
            outCm.sid                       = MY_ID;
-
 
102
            outCm.data_length               = 1;
-
 
103
            outCm.data[0]                   = (lastRefrigeratorDoor==DOOR_OPEN?0:1);
-
 
104
            while(!canSendMessage(outCm,PRIO_HIGH));
-
 
105
        }
-
 
106
 
65
 
107
       
66
       
-
 
67
        if ((tickGet()-heartbeat)>TICK_SECOND*5)
108
        if ((tickGet()-heartbeat)>TICK_SECOND*5)
68
        {
109
        {
69
            // Send alive heartbeat
110
            // Send alive heartbeat
70
            outCm.funct                     = FUNCT_BOOTLOADER;
111
            outCm.funct                     = FUNCT_BOOTLOADER;
71
            outCm.funcc                     = FUNCC_BOOT_HEARTBEAT;
112
            outCm.funcc                     = FUNCC_BOOT_HEARTBEAT;
72
            outCm.nid                       = MY_NID;
113
            outCm.nid                       = MY_NID;
73
            outCm.sid                       = MY_ID;
114
            outCm.sid                       = MY_ID;
74
            outCm.data_length               = 1;
115
            outCm.data_length               = 1;
75
            outCm.data[BOOT_DATA_HEARTBEAT_INDEX] = HEARTBEAT_ALIVE;
116
            outCm.data[BOOT_DATA_HEARTBEAT_INDEX] = HEARTBEAT_ALIVE;
76
            while(!canSendMessage(outCm,PRIO_HIGH));
117
            while(!canSendMessage(outCm,PRIO_HIGH));
77
           
118
           
78
            heartbeat = tickGet();
119
            heartbeat = tickGet();
79
        }
120
        }
-
 
121
 
80
        if ((tickGet()-t)>TICK_SECOND)
122
        if ((tickGet()-t)>TICK_SECOND)
81
        {
123
        {
82
            LED0_IO=~LED0_IO;
124
            LED0_IO=~LED0_IO;
83
            t = tickGet();
125
            t = tickGet();
84
        }
126
        }
-
 
127
 
-
 
128
        #ifdef USE_ADC
-
 
129
        if ((tickGet()-temperature)>TICK_SECOND*2) // Each 2 second, read temperature.
-
 
130
        {
-
 
131
            if (lastTemperature==TEMPERATURE_FREEZER) lastTemperature=TEMPERATURE_REFRIGERATOR; else lastTemperature=TEMPERATURE_FREEZER;
-
 
132
            adcConvert(lastTemperature);
-
 
133
            temperature = tickGet();
-
 
134
        }
-
 
135
        #endif
-
 
136
 
-
 
137
 
-
 
138
        #ifdef USE_ADC
-
 
139
        if (adcDone()) // Has temperature, send it to the bus
-
 
140
        {
-
 
141
            BYTE decimal;
-
 
142
            signed char tenth;
-
 
143
            temperatureRead(&tenth,&decimal);
-
 
144
 
-
 
145
            outCm.funct                     = FUNCT_SENSORS;
-
 
146
            outCm.funcc                     = (lastTemperature==TEMPERATURE_FREEZER?FUNCC_SENSORS_TEMPERATURE_FREEZER:FUNCC_SENSORS_TEMPERATURE_REFRIGERATOR);
-
 
147
            outCm.nid                       = MY_NID;
-
 
148
            outCm.sid                       = MY_ID;
-
 
149
            outCm.data_length               = 2;
-
 
150
            outCm.data[1]                   = tenth; //  signed 10 an 1 decimal.
-
 
151
            outCm.data[0]                   = decimal; //  Decimal value, 0-9
-
 
152
            while(!canSendMessage(outCm,PRIO_HIGH));
-
 
153
        }
-
 
154
        #endif
-
 
155
 
85
    }
156
    }
86
}
157
}
87
 
158
 
88
 
159
 
89
#pragma interrupt high_isr
160
#pragma interrupt high_isr
90
void high_isr(void)
161
void high_isr(void)
91
{
162
{
92
    ClrWdt();
163
    ClrWdt();
93
 
164
 
94
    #ifdef USE_CAN
165
    #ifdef USE_CAN
95
        canISR();
166
        canISR();
96
    #endif
167
    #endif
97
 
-
 
98
    tickUpdate();
-
 
99
 
168
 
-
 
169
    tickUpdate();
-
 
170
 
100
}
171
}
101
 
172
 
102
 
173
 
103
#pragma interrupt low_isr
174
#pragma interrupt low_isr
104
void low_isr(void)
175
void low_isr(void)
105
{
176
{
-
 
177
    #ifdef USE_ADC
-
 
178
        adcISR();
106
 
179
    #endif
107
}
180
}
108
 
181
 
109
 
182
 
110
 
183
 
111
/*
184
/*
112
*   Function: mainInit
185
*   Function: mainInit
113
*
186
*
114
*   Input:  none
187
*   Input:  none
115
*   Output: none
188
*   Output: none
116
*   Pre-conditions: none
189
*   Pre-conditions: none
117
*   Affects: Se code
190
*   Affects: Se code
118
*   Depends: none.
191
*   Depends: none.
119
*/
192
*/
120
void mainInit()
193
void mainInit()
121
{
194
{
122
    LED0_TRIS=0;   
195
    LED0_TRIS=0;   
-
 
196
 
-
 
197
    DOOR_FREEZER_TRIS=1;
-
 
198
    DOOR_REFRIGERATOR_TRIS=1;
123
 
199
 
124
    // Enable Interrupts
200
    // Enable Interrupts
125
    INTCONbits.GIEH = 1;
201
    INTCONbits.GIEH = 1;
126
    INTCONbits.GIEL = 1;
202
    INTCONbits.GIEL = 1;
127
 
203
 
128
    // Enable interrupt prirority
204
    // Enable interrupt prirority
129
    RCONbits.IPEN=1;
205
    RCONbits.IPEN=1;
130
   
206
   
131
 
207
 
132
}
208
}
133
 
209
 
134
/*
210
/*
135
*   Function: canParse
211
*   Function: canParse
136
*
212
*
137
*   Input:  Received can message
213
*   Input:  Received can message
138
*   Output: none
214
*   Output: none
139
*   Pre-conditions: canInit and received packet.
215
*   Pre-conditions: canInit and received packet.
140
*   Affects: Sensors/actuators/etc. See code.
216
*   Affects: Sensors/actuators/etc. See code.
141
*   Depends: none.
217
*   Depends: none.
142
*/
218
*/
143
#ifdef USE_CAN
219
#ifdef USE_CAN
144
void canParse(CAN_MESSAGE cm)
220
void canParse(CAN_MESSAGE cm)
145
{
221
{
146
    CAN_MESSAGE outCm;
222
    CAN_MESSAGE outCm;
147
 
223
 
148
    ClrWdt();
224
    ClrWdt();
149
 
225
 
150
    switch(cm.funct)
226
    switch(cm.funct)
151
    {
227
    {
152
        case FUNCT_BOOTLOADER:
228
        case FUNCT_BOOTLOADER:
153
            if (cm.nid==MY_NID && ((((unsigned int)cm.data[BOOT_DATA_RID_HIGH_INDEX])<<8)+cm.data[BOOT_DATA_RID_LOW_INDEX])==MY_ID)
229
            if (cm.nid==MY_NID && ((((unsigned int)cm.data[BOOT_DATA_RID_HIGH_INDEX])<<8)+cm.data[BOOT_DATA_RID_LOW_INDEX])==MY_ID)
154
            {
230
            {
155
                switch(cm.funcc)
231
                switch(cm.funcc)
156
                {
232
                {
157
                    case FUNCC_BOOT_INIT: Reset(); break; //User whant to program me, reset me.
233
                    case FUNCC_BOOT_INIT: Reset(); break; //User whant to program me, reset me.
158
                    case FUNCC_BOOT_SET_ID:
234
                    case FUNCC_BOOT_SET_ID:
159
                        // Change my ID and NID
235
                        // Change my ID and NID
160
                        MY_ID=(((WORD)cm.data[BOOT_DATA_NEW_ID_HIGH_INDEX])<<8)+cm.data[BOOT_DATA_NEW_ID_LOW_INDEX];
236
                        MY_ID=(((WORD)cm.data[BOOT_DATA_NEW_ID_HIGH_INDEX])<<8)+cm.data[BOOT_DATA_NEW_ID_LOW_INDEX];
161
                        MY_NID=cm.data[BOOT_DATA_NEW_NID_INDEX];
237
                        MY_NID=cm.data[BOOT_DATA_NEW_NID_INDEX];
162
                        EEWrite(NODE_ID_EE+1,cm.data[BOOT_DATA_NEW_ID_HIGH_INDEX]);
238
                        EEWrite(NODE_ID_EE+1,cm.data[BOOT_DATA_NEW_ID_HIGH_INDEX]);
163
                        EEWrite(NODE_ID_EE+2,cm.data[BOOT_DATA_NEW_ID_LOW_INDEX]);
239
                        EEWrite(NODE_ID_EE+2,cm.data[BOOT_DATA_NEW_ID_LOW_INDEX]);
164
                        EEWrite(NODE_ID_EE+3,cm.data[BOOT_DATA_NEW_NID_INDEX]);
240
                        EEWrite(NODE_ID_EE+3,cm.data[BOOT_DATA_NEW_NID_INDEX]);
165
                        EEWrite(NODE_ID_EE,NODE_HAS_ID);
241
                        EEWrite(NODE_ID_EE,NODE_HAS_ID);
166
                        // Send ack with new id.
242
                        // Send ack with new id.
167
                        outCm.funct                     = FUNCT_BOOTLOADER;
243
                        outCm.funct                     = FUNCT_BOOTLOADER;
168
                        outCm.funcc                     = FUNCC_BOOT_ACK;
244
                        outCm.funcc                     = FUNCC_BOOT_ACK;
169
                        outCm.nid                       = MY_NID;
245
                        outCm.nid                       = MY_NID;
170
                        outCm.sid                       = MY_ID;
246
                        outCm.sid                       = MY_ID;
171
                        outCm.data_length               = 8;
247
                        outCm.data_length               = 8;
172
                        outCm.data[BOOT_DATA_ERR_INDEX] = ACK_ERR_NO_ERROR;
248
                        outCm.data[BOOT_DATA_ERR_INDEX] = ACK_ERR_NO_ERROR;
173
                        while(!canSendMessage(outCm,PRIO_HIGH));
249
                        while(!canSendMessage(outCm,PRIO_HIGH));
174
                    break;
250
                    break;
175
                }
251
                }
176
            }
252
            }
177
 
253
 
178
 
254
 
179
        break;
255
        break;
180
    }
256
    }
181
}
257
}
182
#endif
258
#endif
183
 
259
 
184
 
260
 
185
 
261
 
186
// Below are mandantory when using bootloader
262
// Below are mandantory when using bootloader
187
// define DEBUG_MODE to use without bootloader.
263
// define DEBUG_MODE to use without bootloader.
188
 
264
 
189
#ifndef DEBUG_MODE
265
#ifndef DEBUG_MODE
190
extern void _startup (void);
266
extern void _startup (void);
191
#pragma code _RESET_INTERRUPT_VECTOR = 0x001000
267
#pragma code _RESET_INTERRUPT_VECTOR = 0x001000
192
void _reset (void)
268
void _reset (void)
193
{
269
{
194
    _asm goto _startup _endasm
270
    _asm goto _startup _endasm
195
}
271
}
196
#pragma code
272
#pragma code
197
#endif
273
#endif
198
 
274
 
199
#pragma code _HIGH_INTERRUPT_VECTOR = 0x001008
275
#pragma code _HIGH_INTERRUPT_VECTOR = 0x001008
200
void _high_ISR (void)
276
void _high_ISR (void)
201
{
277
{
202
    _asm GOTO high_isr _endasm
278
    _asm GOTO high_isr _endasm
203
}
279
}
204
#pragma code
280
#pragma code
205
 
281
 
206
#pragma code _LOW_INTERRUPT_VECTOR = 0x001018
282
#pragma code _LOW_INTERRUPT_VECTOR = 0x001018
207
void _low_ISR (void)
283
void _low_ISR (void)
208
{
284
{
209
    _asm GOTO low_isr _endasm
285
    _asm GOTO low_isr _endasm
210
}
286
}
211
#pragma code
287
#pragma code
212
 
288