Subversion Repositories HomeAutomation

Rev

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

Rev 26 Rev 31
1
/*********************************************************************
1
/*********************************************************************
2
 *
2
 *
3
 *                  Main application
3
 *                  Main application
4
 *
4
 *
5
 *********************************************************************
5
 *********************************************************************
6
 * FileName:        Main.c
6
 * FileName:        Main.c
7
 *
7
 *
8
 * Author               Date    Comment
8
 * Author               Date    Comment
9
 *~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
9
 *~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
10
 * Johan Böhlin     21-10-06    Original        (Rev 1.0)
10
 * Johan Böhlin     21-10-06    Original        (Rev 1.0)
11
 ********************************************************************/
11
 ********************************************************************/
12
 
12
 
13
#include "../Include/compiler.h"
13
#include "../Include/compiler.h"
14
#include "../Include/stackTasks.h"
14
#include "../Include/stackTasks.h"
15
#include "../Include/Tick.h"
15
#include "../Include/Tick.h"
16
 
16
 
17
#ifdef USE_CAN
17
#ifdef USE_CAN
18
    #include "../Include/CAN.h"
18
    #include "../Include/CAN.h"
19
#endif
19
#endif
20
 
20
 
21
#ifdef USE_UART
21
#ifdef USE_UART
22
    #include "../Include/uart.h"
22
    #include "../Include/uart.h"
23
#endif
23
#endif
24
 
24
 
25
 
25
 
26
 
26
 
27
static void mainInit(void);
27
static void mainInit(void);
-
 
28
 
-
 
29
static BOOL heartBeatEnabled = TRUE;
28
 
30
 
29
void main()
31
void main()
30
{
32
{
31
    static TICK t = 0;
33
    static TICK t = 0;
32
 
34
 
33
    // Inits
35
    // Inits
34
 
36
 
35
    mainInit();
37
    mainInit();
36
 
38
 
37
    #ifdef USE_CAN
39
    #ifdef USE_CAN
38
        canInit();
40
        canInit();
39
    #endif
41
    #endif
40
 
42
 
41
    #ifdef USE_UART
43
    #ifdef USE_UART
42
        uartInit();
44
        uartInit();
43
        uartPutrs("BOOT OK!");
-
 
44
    #endif
45
    #endif
45
 
46
 
46
    tickInit();
47
    tickInit();
47
 
48
 
48
    while(1)
49
    while(1)
49
    {
50
    {
50
        if ((tickGet()-t)>=10*TICK_SECOND)
51
        if ((tickGet()-t)>=5*TICK_SECOND && heartBeatEnabled==TRUE)
51
        {
52
        {
52
            CAN_MESSAGE cm;
53
            CAN_MESSAGE cm;
53
 
54
 
54
            t = tickGet();
55
            t = tickGet();
55
       
56
       
56
            // Send heartbeat
57
            // Send heartbeat
57
            cm.ident=0x00000707;
58
            cm.ident=0x00000666;
58
            cm.extended=FALSE;
59
            cm.extended=FALSE;
59
            cm.data_length=1;
60
            cm.data_length=1;
60
            cm.data[0]='H';
61
            cm.data[0]='H';
61
 
62
 
62
            while(!canSendMessage(cm));
63
            while(!canSendMessage(cm));
63
 
64
 
64
           
65
           
65
        }
66
        }
66
    }
67
    }
67
}
68
}
68
 
69
 
69
 
70
 
70
#pragma interruptlow HighISR
71
#pragma interruptlow HighISR
71
void HighISR(void)
72
void HighISR(void)
72
{
73
{
73
    #ifdef USE_CAN
74
    #ifdef USE_CAN
74
        canISR();
75
        canISR();
75
    #endif
76
    #endif
76
 
77
 
77
    #ifdef USE_UART
78
    #ifdef USE_UART
78
        uartISR();
79
        uartISR();
79
    #endif
80
    #endif
80
 
81
 
81
    tickUpdate();
82
    tickUpdate();
82
}
83
}
83
#pragma code highVector=0x08
84
#pragma code highVector=0x08
84
void HighVector (void)
85
void HighVector (void)
85
{
86
{
86
    _asm goto HighISR _endasm
87
    _asm goto HighISR _endasm
87
}
88
}
88
#pragma code // Return to default code section
89
#pragma code // Return to default code section
89
 
90
 
90
 
91
 
91
 
92
 
92
#pragma interruptlow LowISR
93
#pragma interruptlow LowISR
93
void LowISR(void)
94
void LowISR(void)
94
{
95
{
95
 
96
 
96
}
97
}
97
#pragma code lowVector=0x18
98
#pragma code lowVector=0x18
98
void LowVector (void)
99
void LowVector (void)
99
{
100
{
100
    _asm goto LowISR _endasm
101
    _asm goto LowISR _endasm
101
}
102
}
102
#pragma code // Return to default code section
103
#pragma code // Return to default code section
103
 
104
 
104
 
105
 
105
/*
106
/*
106
*   Function: mainInit
107
*   Function: mainInit
107
*
108
*
108
*   Input:  none
109
*   Input:  none
109
*   Output: none
110
*   Output: none
110
*   Pre-conditions: none
111
*   Pre-conditions: none
111
*   Affects: Se code
112
*   Affects: Se code
112
*   Depends: none.
113
*   Depends: none.
113
*/
114
*/
114
void mainInit()
115
void mainInit()
115
{
116
{
116
    LED0_TRIS=0;   
117
    LED0_TRIS=0;   
117
 
118
 
118
    // Enable internal PORTB pull-ups
119
    // Enable internal PORTB pull-ups
119
    INTCON2bits.RBPU = 0;
120
    INTCON2bits.RBPU = 0;
120
   
121
   
121
    // Enable Interrupts
122
    // Enable Interrupts
122
    INTCONbits.GIEH = 1;
123
    INTCONbits.GIEH = 1;
123
    INTCONbits.GIEL = 1;
124
    INTCONbits.GIEL = 1;
124
 
125
 
125
}
126
}
126
 
127
 
127
/*
128
/*
128
*   Function: canParse
129
*   Function: canParse
129
*
130
*
130
*   Input:  Received can message
131
*   Input:  Received can message
131
*   Output: none
132
*   Output: none
132
*   Pre-conditions: canInit and received packet.
133
*   Pre-conditions: canInit and received packet.
133
*   Affects: Sensors/actuators/etc. See code.
134
*   Affects: Sensors/actuators/etc. See code.
134
*   Depends: none.
135
*   Depends: none.
135
*/
136
*/
136
#ifdef USE_CAN
137
#ifdef USE_CAN
137
void canParse(CAN_MESSAGE cm)
138
void canParse(CAN_MESSAGE cm)
138
{
139
{
139
    int i=0;
140
    int i=0;
140
 
141
   
141
    if (cm.extended==TRUE)
142
    uartPutc(UART_START_BYTE);
142
    {
143
    uartPutc((BYTE)(cm.ident));
-
 
144
    uartPutc((BYTE)(cm.ident>>8));
-
 
145
    uartPutc((BYTE)(cm.ident>>16));
143
        uartPutc((BYTE)(cm.ident>>24));
146
    uartPutc((BYTE)(cm.ident>>24));
144
        uartPutc((BYTE)(cm.ident>>16));
-
 
145
    }
-
 
146
    uartPutc((BYTE)(cm.ident>>8));
147
    uartPutc(cm.extended);
147
    uartPutc((BYTE)(cm.ident));
148
    uartPutc(cm.data_length);
148
 
-
 
149
    for(i=0;i<cm.data_length && i<8;i++)
149
    for(i=0;i<8;i++) uartPutc(cm.data[cm.data_length-i-1]);
150
        uartPutc(cm.data[cm.data_length-i-1]);
150
    uartPutc(UART_END_BYTE);
151
 
151
 
152
}
152
}
153
#endif
153
#endif
154
 
154
 
155
 
155
 
156
/*
156
/*
157
*   Function: uartParse
157
*   Function: uartParse
158
*
158
*
159
*   Input:  Received uart message
159
*   Input:  Received uart message
160
*   Output: none
160
*   Output: none
161
*   Pre-conditions: uartInit and received byte.
161
*   Pre-conditions: uartInit and received byte.
162
*   Affects: Sensors/actuators/etc. See code.
162
*   Affects: Sensors/actuators/etc. See code.
163
*   Depends: none.
163
*   Depends: none.
164
*/
164
*/
165
#ifdef USE_UART
165
#ifdef USE_UART
166
void uartParse(BYTE c)
166
void uartParse(BYTE c)
167
{
167
{
168
 
168
 
169
 
169
 
170
    if (c=='1')
170
    if (c=='1')
171
    {
171
    {
172
        CAN_MESSAGE cm;
172
        CAN_MESSAGE cm;
173
        cm.ident=0x00000123;
173
        cm.ident=0x00000123;
174
        cm.extended=FALSE;
174
        cm.extended=FALSE;
175
        cm.data_length=4;
175
        cm.data_length=4;
176
        cm.data[0]='!';
176
        cm.data[0]='!';
177
        cm.data[1]='j';
177
        cm.data[1]='j';
178
        cm.data[2]='e';
178
        cm.data[2]='e';
179
        cm.data[3]='H';
179
        cm.data[3]='H';
180
 
180
 
181
        while(!canSendMessage(cm));
181
        while(!canSendMessage(cm));
182
    }
182
    }
183
 
183
 
184
    if (c=='2')
184
    if (c=='2')
185
    {
185
    {
186
        CAN_MESSAGE cm;
186
        CAN_MESSAGE cm;
187
        cm.ident=0x0ABCDEF0;
187
        cm.ident=0x0ABCDEF0;
188
        cm.extended=TRUE;
188
        cm.extended=TRUE;
189
        cm.data_length=8;
189
        cm.data_length=8;
190
        cm.data[0]='!';
190
        cm.data[0]='!';
191
        cm.data[1]='g';
191
        cm.data[1]='g';
192
        cm.data[2]='a';
192
        cm.data[2]='a';
193
        cm.data[3]='d';
193
        cm.data[3]='d';
194
        cm.data[4]=' ';
194
        cm.data[4]=' ';
195
        cm.data[5]='d';
195
        cm.data[5]='d';
196
        cm.data[6]='o';
196
        cm.data[6]='o';
197
        cm.data[7]='G';
197
        cm.data[7]='G';
198
 
198
 
199
 
199
 
-
 
200
        while(!canSendMessage(cm));
-
 
201
    }
-
 
202
 
-
 
203
    if (c=='3')
-
 
204
    {
-
 
205
        CAN_MESSAGE cm;
-
 
206
        cm.ident=0x00000010;
-
 
207
        cm.extended=FALSE;
-
 
208
        cm.data_length=6;
-
 
209
        cm.data[0]='0';
-
 
210
        cm.data[1]='1';
-
 
211
        cm.data[2]='2';
-
 
212
        cm.data[3]='3';
-
 
213
        cm.data[4]='4';
-
 
214
        cm.data[5]='5';
-
 
215
 
200
        while(!canSendMessage(cm));
216
        while(!canSendMessage(cm));
201
    }
217
    }
202
 
218
 
203
    if (c=='d')
219
    if (c=='d')
204
    {
220
    {
205
        uartPutc('D');
221
        //uartPutc('D');
206
    }
222
    }
207
 
223
 
208
    if (c=='D')
224
    if (c=='D')
209
    {
225
    {
210
        uartPutrs("Debug? Debug!");
226
        //uartPutrs("Debug? Debug!");
-
 
227
    }
-
 
228
 
-
 
229
    if (c=='T')
-
 
230
    {
-
 
231
        heartBeatEnabled=(heartBeatEnabled==TRUE?FALSE:TRUE);
211
    }
232
    }
212
 
233
 
213
    if (c=='3')
234
    if (c=='4')
214
    {
235
    {
-
 
236
        /*
215
        uartPutc(RXB0CON);
237
        uartPutc(RXB0CON);
216
        uartPutc(RXB1CON);
238
        uartPutc(RXB1CON);
217
        uartPutc(123);
239
        uartPutc(123);
218
        uartPutc(B0CON);
240
        uartPutc(B0CON);
219
        uartPutc(B1CON);
241
        uartPutc(B1CON);
220
        uartPutc(B2CON);
242
        uartPutc(B2CON);
221
        uartPutc(123); 
243
        uartPutc(123); 
222
        uartPutc(B3CON);   
244
        uartPutc(B3CON);   
223
        uartPutc(B4CON);   
245
        uartPutc(B4CON);   
224
        uartPutc(B5CON);
246
        uartPutc(B5CON);
225
        uartPutc(123); 
247
        uartPutc(123); 
226
        uartPutc(CANSTAT); 
248
        uartPutc(CANSTAT); 
227
        uartPutc(COMSTAT); 
249
        uartPutc(COMSTAT); 
228
        uartPutc(ECANCON);
250
        uartPutc(ECANCON);
229
        uartPutc(123); 
251
        uartPutc(123); 
230
        uartPutc(TXB0CON); 
252
        uartPutc(TXB0CON); 
231
        uartPutc(TXB1CON); 
253
        uartPutc(TXB1CON); 
232
        uartPutc(TXB2CON); 
254
        uartPutc(TXB2CON); 
233
        uartPutc(123);
255
        uartPutc(123);
234
        uartPutc(PIR3);
256
        uartPutc(PIR3);
235
        uartPutc(PIE3);
257
        uartPutc(PIE3);
236
        uartPutc(123);
258
        uartPutc(123);
237
        uartPutc(BRGCON1);
259
        uartPutc(BRGCON1);
238
        uartPutc(BRGCON2);
260
        uartPutc(BRGCON2);
239
        uartPutc(BRGCON3);
261
        uartPutc(BRGCON3);
240
        uartPutc(123);
262
        uartPutc(123);
241
        uartPutc(RXFCON0);
263
        uartPutc(RXFCON0);
242
        uartPutc(RXFCON1);
264
        uartPutc(RXFCON1);
243
        uartPutc(123);
265
        uartPutc(123);
244
        uartPutc(RXFBCON0);
266
        uartPutc(RXFBCON0);
245
        uartPutc(RXFBCON1);
267
        uartPutc(RXFBCON1);
246
        uartPutc(RXFBCON2);
268
        uartPutc(RXFBCON2);
247
        uartPutc(RXFBCON3);
269
        uartPutc(RXFBCON3);
248
        uartPutc(RXFBCON4);
270
        uartPutc(RXFBCON4);
249
        uartPutc(RXFBCON5);
271
        uartPutc(RXFBCON5);
250
        uartPutc(RXFBCON6);
272
        uartPutc(RXFBCON6);
251
        uartPutc(RXFBCON7);
273
        uartPutc(RXFBCON7);
252
        uartPutc(123);
274
        uartPutc(123);
253
        uartPutc(TXBIE);
275
        uartPutc(TXBIE);
254
        uartPutc(BIE0);
276
        uartPutc(BIE0);
-
 
277
        */
255
    }
278
    }
256
 
279
 
257
}
280
}
258
#endif
281
#endif
259
 
282