Subversion Repositories HomeAutomation

Rev

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

Rev 259 Rev 261
1
#include "bios_funs.h"
1
#include "bios_funs.h"
2
#include "avr_cfg.h"
2
#include "avr_cfg.h"
3
#include <inttypes.h>
3
#include <inttypes.h>
4
#include <avr/io.h>
4
#include <avr/io.h>
5
#include <avr/interrupt.h>
5
#include <avr/interrupt.h>
6
#include <avr/wdt.h>
6
#include <avr/wdt.h>
7
#include <avr/pgmspace.h>
7
#include <avr/pgmspace.h>
8
#ifdef BIOS_UART
8
#ifdef BIOS_UART
9
#include <stdio.h>
9
#include <stdio.h>
10
#endif
10
#endif
11
#include <string.h>
11
#include <string.h>
12
#include "flash.h"
12
#include "flash.h"
13
#include "vectors.h" // Must be included after sfr_defs.h but before any ISR()
13
#include "vectors.h" // Must be included after sfr_defs.h but before any ISR()
14
#include "mcp2515/mcp2515.h"
14
#include "mcp2515/mcp2515.h"
15
 
15
 
16
//---------------------------------------------------------------------------
16
//---------------------------------------------------------------------------
17
// Globals
17
// Globals
18
 
18
 
19
volatile uint32_t gMilliSecTick;
19
volatile uint32_t gMilliSecTick;
20
volatile uint8_t bios_msg_full;
20
volatile uint8_t bios_msg_full;
21
Can_Message_t* bios_msg_ptr; // only a pointer to main-local structure to save .bss space
21
Can_Message_t* bios_msg_ptr; // only a pointer to main-local structure to save .bss space
22
 
22
 
23
//---------------------------------------------------------------------------
23
//---------------------------------------------------------------------------
24
// Function definitions for the exported interface
24
// Function definitions for the exported interface
25
 
25
 
26
void reset(void) {
26
void reset(void) {
27
    //Just loop and let the watchdog reset
27
    //Just loop and let the watchdog reset
28
    cli();
28
    cli();
29
    while(1);
29
    while(1);
30
}
30
}
31
 
31
 
32
#ifdef BIOS_UART
32
#ifdef BIOS_UART
33
void bios_putchar(char c) {
33
void bios_putchar(char c) {
34
    UART_PUTCHAR(c);
34
    UART_PUTCHAR(c);
35
}
35
}
36
 
36
 
37
char bios_getchar(void) {
37
char bios_getchar(void) {
38
    char c;
38
    char c;
39
    UART_GETCHAR(c)
39
    UART_GETCHAR(c)
40
    return c;
40
    return c;
41
}
41
}
42
#endif
42
#endif
43
 
43
 
44
unsigned long timebase_get(void) {
44
unsigned long timebase_get(void) {
45
    uint8_t sreg;
45
    uint8_t sreg;
46
    unsigned long res;
46
    unsigned long res;
47
   
47
   
48
    //Disable interrupts while reading tick count
48
    //Disable interrupts while reading tick count
49
    sreg=SREG;
49
    sreg=SREG;
50
    cli();
50
    cli();
51
   
51
   
52
    res = gMilliSecTick;
52
    res = gMilliSecTick;
53
   
53
   
54
    SREG=sreg;
54
    SREG=sreg;
55
   
55
   
56
    return res;
56
    return res;
57
}
57
}
58
 
58
 
59
// TODO: Insert can driver's Can_Send directly in bios interface.
59
// TODO: Insert can driver's Can_Send directly in bios interface.
60
Can_Return_t can_send(Can_Message_t* msg) {
60
Can_Return_t can_send(Can_Message_t* msg) {
61
    return Can_Send(msg);
61
    return Can_Send(msg);
62
}
62
}
63
 
63
 
64
//---------------------------------------------------------------------------
64
//---------------------------------------------------------------------------
65
// Function definitions for the private functions
65
// Function definitions for the private functions
66
 
66
 
67
#ifdef BIOS_UART
67
#ifdef BIOS_UART
68
static int console_getchar(FILE *stream) {
68
static int console_getchar(FILE *stream) {
69
    return bios_getchar();
69
    return bios_getchar();
70
}
70
}
71
 
71
 
72
static int console_putchar(char c, FILE *stream) {
72
static int console_putchar(char c, FILE *stream) {
73
    bios_putchar(c);
73
    bios_putchar(c);
74
    return 0;
74
    return 0;
75
}
75
}
76
 
76
 
77
static FILE bios_stdio = FDEV_SETUP_STREAM(console_putchar, console_getchar,
77
static FILE bios_stdio = FDEV_SETUP_STREAM(console_putchar, console_getchar,
78
                                         _FDEV_SETUP_RW);
78
                                         _FDEV_SETUP_RW);
79
#endif
79
#endif
80
 
80
 
81
//---------------------------------------------------------------------------
81
//---------------------------------------------------------------------------
82
// Interrupt Service Routines
82
// Interrupt Service Routines
83
// Read app_vectors.h!
83
// Read app_vectors.h!
84
 
84
 
85
ISR(TIMEBASE_VECTOR) {
85
ISR(TIMEBASE_VECTOR) {
86
    TIMEBASE_COUNTER -= TIMEBASE_RELOAD;
86
    TIMEBASE_COUNTER -= TIMEBASE_RELOAD;
87
    gMilliSecTick++;
87
    gMilliSecTick++;
88
    wdt_reset();
88
    wdt_reset();
89
}
89
}
90
 
90
 
91
void Can_Process(Can_Message_t* msg) {
91
void Can_Process(Can_Message_t* msg) {
92
    if (!(msg->ExtendedFlag)) return;
92
    if (!(msg->ExtendedFlag)) return;
93
   
93
   
94
    //applikationen ska bara ta hand om paket som inte är nmt så else:et nedan kommer om det inte är nmt enbart
94
    //applikationen ska bara ta hand om paket som inte är nmt så else:et nedan kommer om det inte är nmt enbart
95
    if ((msg->Id & CAN_MASK_CLASS) == ((uint32_t)CAN_NMT << CAN_SHIFT_CLASS)) {
95
    if ((msg->Id & CAN_MASK_CLASS) == ((uint32_t)CAN_NMT << CAN_SHIFT_CLASS)) {
96
        if ((msg->Id & CAN_MASK_NMT_RID) == ((uint32_t)NODE_ID << CAN_SHIFT_NMT_RID)) {
96
        if ((msg->Id & CAN_MASK_NMT_RID) == ((uint32_t)NODE_ID << CAN_SHIFT_NMT_RID)) {
97
            //printf("BIOS received msg!\n");
97
            //printf("BIOS received msg!\n");
98
            if ((msg->Id & CAN_MASK_NMT_TYPE)>>CAN_SHIFT_NMT_TYPE == CAN_NMT_RESET) {
98
            if ((msg->Id & CAN_MASK_NMT_TYPE)>>CAN_SHIFT_NMT_TYPE == CAN_NMT_RESET) {
99
                reset();
99
                reset();
100
            }
100
            }
101
            // Copy message to bios buffer if bios is done with the previous message.
101
            // Copy message to bios buffer if bios is done with the previous message.
102
            // This is also a check to see if bios is still running. When app is
102
            // This is also a check to see if bios is still running. When app is
103
            // started, bios_msg_full is never reset to 0 so the check fails and all
103
            // started, bios_msg_full is never reset to 0 so the check fails and all
104
            // NMT communication except reset is ignored. 
104
            // NMT communication except reset is ignored. 
105
            if (!(bios_msg_full)) {
105
            if (!(bios_msg_full)) {
106
                memcpy(bios_msg_ptr, msg, sizeof(Can_Message_t));
106
                memcpy(bios_msg_ptr, msg, sizeof(Can_Message_t));
107
                bios_msg_full = 1;
107
                bios_msg_full = 1;
108
            }      
108
            }      
109
        } else if (bios->can_callback) {
109
        } else if (bios->can_callback) {
110
            //printf("Calling app callback.\n");
110
            //printf("Calling app callback.\n");
111
            bios->can_callback(msg);
111
            bios->can_callback(msg);
112
        }
112
        }
113
    }
113
    }
114
}
114
}
115
 
115
 
116
#define BIOS_APP    1
116
#define BIOS_APP    1
117
#define BIOS_NOAPP  2
117
#define BIOS_NOAPP  2
118
#define BIOS_PGM    3
118
#define BIOS_PGM    3
119
 
119
 
120
int main() {
120
int main() {
121
    void (*app_reset)(void) = 0;
121
    void (*app_reset)(void) = 0;
122
    uint8_t bios_state;
122
    uint8_t bios_state;
123
    uint8_t nmt_type;
123
    uint8_t nmt_type;
124
    uint16_t base_addr = 0;
124
    uint16_t base_addr = 0;
125
    uint16_t offset;
125
    uint16_t offset;
126
    uint16_t addr;
126
    uint16_t addr;
127
    uint8_t len;
127
    uint8_t len;
128
    uint8_t i;
128
    uint8_t i;
129
    uint16_t data;
129
    uint16_t data;
130
    Can_Message_t tx_msg;
130
    Can_Message_t tx_msg;
131
    Can_Message_t bios_msg;
131
    Can_Message_t bios_msg;
132
    bios_msg_ptr = &bios_msg;
132
    bios_msg_ptr = &bios_msg;
133
   
133
   
134
#ifdef BIOS_UART
134
#ifdef BIOS_UART
135
    // Setup USART for debug channel
135
    // Setup USART for debug channel
136
    UART_INIT();
136
    UART_INIT();
137
    stdout = &bios_stdio;
137
    stdout = &bios_stdio;
138
    stdin = &bios_stdio;
138
    stdin = &bios_stdio;
139
#endif
139
#endif
140
   
140
   
141
    // Initialize a suitable hardware timer to create a 1KHz interrupt.
141
    // Initialize a suitable hardware timer to create a 1KHz interrupt.
142
    TIMEBASE_INIT();
142
    TIMEBASE_INIT();
143
   
143
   
144
    // Enable watchdog timer to protect against an application locking the
144
    // Enable watchdog timer to protect against an application locking the
145
    // node by leaving interrupts disabled. 
145
    // node by leaving interrupts disabled. 
146
    wdt_enable(WDTO_500MS);
146
    wdt_enable(WDTO_500MS);
147
   
147
   
148
    // Move interrupt vectors to start of bootloader section and enable interrupts
148
    // Move interrupt vectors to start of bootloader section and enable interrupts
149
    IVSEL_REG = _BV(IVCE);
149
    IVSEL_REG = _BV(IVCE);
150
    IVSEL_REG = _BV(IVSEL);
150
    IVSEL_REG = _BV(IVSEL);
151
    sei();
151
    sei();
152
   
152
   
153
    if (Can_Init() != CAN_OK) reset();
153
    if (Can_Init() != CAN_OK) reset();
154
   
154
   
155
    tx_msg.RemoteFlag = 0;
155
    tx_msg.RemoteFlag = 0;
156
    tx_msg.ExtendedFlag = 1;
156
    tx_msg.ExtendedFlag = 1;
157
    tx_msg.Id = CAN_ID_NMT_BIOS_START;
157
    tx_msg.Id = CAN_ID_NMT_BIOS_START;
158
    tx_msg.DataLength = 3;
158
    tx_msg.DataLength = 3;
159
    tx_msg.Data.words[0] = BIOS_VERSION;
159
    tx_msg.Data.words[0] = BIOS_VERSION;
160
           
160
           
161
    if (pgm_read_word(0) == 0xffff) {
161
    if (pgm_read_word(0) == 0xffff) {
162
        // No application in flash
162
        // No application in flash
163
        //send CAN_NMT_BIOS_START(BIOS_VERSION, 0)
163
        //send CAN_NMT_BIOS_START(BIOS_VERSION, 0)
164
        tx_msg.Data.bytes[2] = 0;
164
        tx_msg.Data.bytes[2] = 0;
165
        bios_state = BIOS_NOAPP;
165
        bios_state = BIOS_NOAPP;
166
    } else {
166
    } else {
167
        // Application exists
167
        // Application exists
168
        //send CAN_NMT_BIOS_START(BIOS_VERSION, 1)
168
        //send CAN_NMT_BIOS_START(BIOS_VERSION, 1)
169
        tx_msg.Data.bytes[2] = 1;
169
        tx_msg.Data.bytes[2] = 1;
170
        //for now, set state to BIOS_NOAPP to be able to reprogram application
-
 
171
        bios_state = BIOS_NOAPP;
170
        bios_state = BIOS_APP;
172
    }
171
    }
173
   
172
   
174
    while (Can_Send(&tx_msg) != CAN_OK);
173
    while (Can_Send(&tx_msg) != CAN_OK);
175
 
174
 
176
    tx_msg.DataLength = 2;
175
    tx_msg.DataLength = 2;
177
   
176
   
178
    // main loop
177
    // main loop
179
    while (1) {
178
    while (1) {
180
        // Wait for message
179
        // Wait for message
181
        while (!bios_msg_full);
180
        while (!bios_msg_full);
182
        nmt_type = (bios_msg.Id & CAN_MASK_NMT_TYPE)>>CAN_SHIFT_NMT_TYPE;
181
        nmt_type = (bios_msg.Id & CAN_MASK_NMT_TYPE)>>CAN_SHIFT_NMT_TYPE;
183
       
182
       
184
        switch (bios_state) {
183
        switch (bios_state) {
185
        case BIOS_APP:
184
        case BIOS_APP:
186
            if (nmt_type == CAN_NMT_START_APP) {
185
            if (nmt_type == CAN_NMT_START_APP) {
187
                app_reset(); // Will never return
186
                app_reset(); // Will never return
188
            }
187
            }
189
            // Fall through
188
            // Fall through
190
        case BIOS_NOAPP:
189
        case BIOS_NOAPP:
191
            if (nmt_type == CAN_NMT_PGM_START) {
190
            if (nmt_type == CAN_NMT_PGM_START) {
192
                // Set base address
191
                // Set base address
193
                base_addr = bios_msg.Data.words[0];
192
                base_addr = bios_msg.Data.words[0];
194
                flash_init();
193
                flash_init();
195
                //send CAN_NMT_PGM_ACK(offset)
194
                //send CAN_NMT_PGM_ACK(offset)
196
                tx_msg.Id = CAN_ID_NMT_PGM_ACK;
195
                tx_msg.Id = CAN_ID_NMT_PGM_ACK;
197
                tx_msg.Data.words[0] = base_addr;
196
                tx_msg.Data.words[0] = base_addr;
198
                bios_state = BIOS_PGM;
197
                bios_state = BIOS_PGM;
199
                while (Can_Send(&tx_msg) != CAN_OK);
198
                while (Can_Send(&tx_msg) != CAN_OK);
200
            }
199
            }
201
            break;
200
            break;
202
        case BIOS_PGM:
201
        case BIOS_PGM:
203
            if (nmt_type == CAN_NMT_PGM_DATA) {
202
            if (nmt_type == CAN_NMT_PGM_DATA) {
204
                // Set address = base address + offset
203
                // Set address = base address + offset
205
                offset = bios_msg.Data.words[0];
204
                offset = bios_msg.Data.words[0];
206
                addr = base_addr + offset;
205
                addr = base_addr + offset;
207
                tx_msg.Data.words[0] = offset;
206
                tx_msg.Data.words[0] = offset;
208
                // TODO: Check (addr + dlc) valid instead
207
                // TODO: Check (addr + dlc) valid instead
209
                if (addr < (uint16_t)&__bios_start) { //address valid
208
                if (addr < (uint16_t)&__bios_start) { //address valid
210
                    //flash data at address
209
                    //flash data at address
211
                    len = (bios_msg.DataLength+1)/2; // Number of words in message, rounded up.
210
                    len = (bios_msg.DataLength+1)/2; // Number of words in message, rounded up.
212
                    for (i=1; i<len; i++) { // Skip first word (offset)
211
                    for (i=1; i<len; i++) { // Skip first word (offset)
213
                        data = bios_msg.Data.words[i];
212
                        data = bios_msg.Data.words[i];
214
                        flash_write_word(addr, data);
213
                        flash_write_word(addr, data);
215
                        addr += 2;
214
                        addr += 2;
216
                    }
215
                    }
217
                    //update crc
216
                    //update crc
218
                    //send CAN_NMT_PGM_ACK(offset)
217
                    //send CAN_NMT_PGM_ACK(offset)
219
                    tx_msg.Id = CAN_ID_NMT_PGM_ACK;
218
                    tx_msg.Id = CAN_ID_NMT_PGM_ACK;
220
                } else {
219
                } else {
221
                    //send CAN_NMT_PGM_NACK(offset)
220
                    //send CAN_NMT_PGM_NACK(offset)
222
                    tx_msg.Id = CAN_ID_NMT_PGM_NACK;
221
                    tx_msg.Id = CAN_ID_NMT_PGM_NACK;
223
                }
222
                }
224
            }
223
            }
225
            if (nmt_type == CAN_NMT_PGM_END) {
224
            if (nmt_type == CAN_NMT_PGM_END) {
226
                flash_flush_buffer();
225
                flash_flush_buffer();
227
                //check crc
226
                //check crc
228
                //tx_msg.Data.words[0] = crc;
227
                //tx_msg.Data.words[0] = crc;
229
                if (1) { //crc ok
228
                if (1) { //crc ok
230
                    //send CAN_NMT_PGM_ACK(crc)
229
                    //send CAN_NMT_PGM_ACK(crc)
231
                    tx_msg.Id = CAN_ID_NMT_PGM_ACK;
230
                    tx_msg.Id = CAN_ID_NMT_PGM_ACK;
232
                } else {
231
                } else {
233
                    //send CAN_NMT_PGM_NACK(crc)
232
                    //send CAN_NMT_PGM_NACK(crc)
234
                    tx_msg.Id = CAN_ID_NMT_PGM_NACK;
233
                    tx_msg.Id = CAN_ID_NMT_PGM_NACK;
235
                }
234
                }
236
                bios_state = BIOS_NOAPP;
235
                bios_state = BIOS_NOAPP;
237
            }
236
            }
238
            while (Can_Send(&tx_msg) != CAN_OK);
237
            while (Can_Send(&tx_msg) != CAN_OK);
239
        }
238
        }
240
 
239
 
241
        bios_msg_full = 0; // We're done with this message, ready for the next.
240
        bios_msg_full = 0; // We're done with this message, ready for the next.
242
    }
241
    }
243
 
242
 
244
    return 0;
243
    return 0;
245
}
244
}
246
 
245