testBootXmega/bootboard.cpp at master · AndreyShi/testBootXmega · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
/*
 * testBoot.cpp
 *
 * Created: 31.05.2018 14:35:49
 * Author : Andrew
 */

#define F_CPU 32000000UL
#define APP_END                   (APP_SECTION_START + APP_SECTION_SIZE)

#include <avr/io.h>
//#include <avr/pgmspace.h>
#include <avr/interrupt.h>        // 50 bytes PM
#include <util/delay.h>
#include "CSerial.h"
#include "CPin.h"
#include "CInterrupt.h"
#include "CCpu.h"
#include "CTwi.h"
#include "CRtc.h"
#include "enum.h"
#include "sp_driver.h"


extern "C"{extern void CCP_RST( void );}


bool end_of_flashing;
void exitboot();

void exitboot(){
	void (*gotozero)() = 0x0000;
	cli();
	SP_WaitForSPM();
	SP_LockSPM();
	USARTD1_CTRLA = USART_RXCINTLVL_OFF_gc;
	EIND = 0x00;
	gotozero();
}

 int main(void)
{

   CCpu          cpu32Mhz;
   CInterrupt    inter(Boot);
   CPin          pin0portK(&PORTK,PIN0_bm,pin_out);
   CPin          pin2portQ(&PORTQ,PIN2_bm,pin_out);
   CPin          pin5portK(&PORTK,PIN5_bm,pin_in);
   CSerial       InitUart(bdrate200000,microe793);
   //CSerial       InitUart(bdrate200000,lir540);
   CTwi          InitTwi(Twi100Khz);
   //CRtc          rtc(793);


   pin5portK.PullDown();

   bool Onboot  = false;

   inter.enable();

    while (1)
    {
	   pin0portK.shim10n100();


	    if(pin5portK.OnPin()) // || Onboot
	    {
		    Onboot = true;
	    }
	    if(!pin5portK.OnPin() || end_of_flashing)
	    {
		    pin0portK.outclr();
			pin2portQ.shim10n100();
		    exitboot();
	    }
    }
}

ISR(RTC_OVF_vect)
{
	CPin  pin2portK(&PORTK,PIN2_bm,pin_out);

	pin2portK.outset();
	_delay_us(70);

	pin2portK.outclr();
	//_delay_ms(5);

}

ISR(USARTC0_RXC_vect)
{

	CSerial       uart(&USARTC0);
	CTwi          twi;

	unsigned char block[700] = { 0 };
	unsigned char answerFlash[] = { 0xff,0x02,0x04,0x0A };

	uart.Recievedblock(block,sizeof(block));

	if ( block[3] == WRITE_ || block[3] == 0x83)
	{
		unsigned long addres_page;

		if(block[3] == 0x83)
			addres_page = 255 + (int)block[6];
		else
			addres_page = (int)block[6] - 1;

		addres_page = addres_page * 512;

		if(addres_page >= APP_END)
			return;

		for(int x=0;x<APP_SECTION_PAGE_SIZE;x+=2)
		{
			uint16_t word;
			word = (uint8_t) block[x + 8];          //low
			word |= (uint8_t) block[x + 9]<<8;      //hi
			SP_WaitForSPM();
			SP_LoadFlashWord(x, word);
		}
		SP_WaitForSPM();
		SP_EraseWriteApplicationPage(addres_page);

		uart.TransmitBlock(answerFlash,sizeof(answerFlash));
	}


	if ( block[3] == TEST_ && block[4] == TEST_ ){ uart.TransmitBlock(block,8); }

	if ( block[3] == SET_TIME && block[4] == SET_TIME) { uart.TransmitBlock(block,1); }

	if ( block[3] == WRITE_CHECK_ONES){ end_of_flashing = true;}

	return;
}