Rev 770 | Rev 877 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | SVN | RSS feed
| Rev 770 | Rev 876 | ||
|---|---|---|---|
| 1 | using System; |
1 | using System; |
| 2 | using System.Collections.Generic; |
2 | using System.Collections.Generic; |
| 3 | using System.Text; |
3 | using System.Text; |
| 4 | using System.Threading; |
4 | using System.Threading; |
| 5 | 5 | ||
| 6 | //this class should probably be integrated into canNMT instead |
6 | //this class should probably be integrated into canNMT instead |
| 7 | 7 | ||
| 8 | public class Downloader { |
8 | public class Downloader { |
| 9 | private HexFile hf; |
9 | private HexFile hf; |
| 10 | private DaemonConnection dc; |
10 | private DaemonConnection dc; |
| 11 | private bool isBiosUpdate; |
11 | private bool isBiosUpdate; |
| 12 | private ulong dlOffset = 0; |
12 | private ulong dlOffset = 0; |
| 13 | //private Thread down; |
13 | //private Thread down; |
| 14 | private byte receiveID; |
14 | private byte receiveID; |
| 15 | private uint hwid; |
15 | private uint hwid; |
| 16 | private bool HWID_INUSE; |
16 | private bool HWID_INUSE; |
| 17 | 17 | ||
| 18 | private enum dState { SEND_START, WAIT_ACK_PRG, SEND_PGM_DATA, WAIT_ACK_DATA, RESEND_ADDR, WAIT_DONE, SEND_DONE, SEND_BIOS_UPDATE, SEND_RESET, DONE, DEBUG_STATE2, WAIT_BOOT, SEND_EMPTY_START, WAIT_ACK_PRG_EMPTY, SEND_EMPTY_DATA, WAIT_ACK_EMPTY_DATA, SEND_DONE_EMPTY, WAIT_DONE_EMPTY}; |
18 | private enum dState { SEND_START, WAIT_ACK_PRG, SEND_PGM_DATA, WAIT_ACK_DATA, RESEND_ADDR, WAIT_DONE, SEND_DONE, SEND_BIOS_UPDATE, SEND_RESET, DONE, DEBUG_STATE2, WAIT_BOOT, SEND_EMPTY_START, WAIT_ACK_PRG_EMPTY, SEND_EMPTY_DATA, WAIT_ACK_EMPTY_DATA, SEND_DONE_EMPTY, WAIT_DONE_EMPTY}; |
| 19 | 19 | ||
| 20 | private const byte CAN_NMT = 0x00; |
20 | private const byte CAN_NMT = 0x00; |
| 21 | 21 | ||
| 22 | private const byte CAN_NMT_RESET = 0x04; |
22 | private const byte CAN_NMT_RESET = 0x04; |
| 23 | private const byte CAN_NMT_BIOS_START = 0x08; |
23 | private const byte CAN_NMT_BIOS_START = 0x08; |
| 24 | private const byte CAN_NMT_PGM_START = 0x0C; |
24 | private const byte CAN_NMT_PGM_START = 0x0C; |
| 25 | private const byte CAN_NMT_PGM_DATA = 0x10; |
25 | private const byte CAN_NMT_PGM_DATA = 0x10; |
| 26 | private const byte CAN_NMT_PGM_END = 0x14; |
26 | private const byte CAN_NMT_PGM_END = 0x14; |
| 27 | private const byte CAN_NMT_PGM_COPY = 0x18; |
27 | private const byte CAN_NMT_PGM_COPY = 0x18; |
| 28 | private const byte CAN_NMT_PGM_ACK = 0x1C; |
28 | private const byte CAN_NMT_PGM_ACK = 0x1C; |
| 29 | private const byte CAN_NMT_PGM_NACK = 0x20; |
29 | private const byte CAN_NMT_PGM_NACK = 0x20; |
| 30 | private const byte CAN_NMT_START_APP = 0x24; |
30 | private const byte CAN_NMT_START_APP = 0x24; |
| 31 | private const byte CAN_NMT_APP_START = 0x28; |
31 | private const byte CAN_NMT_APP_START = 0x28; |
| 32 | private const byte CAN_NMT_HEARTBEAT = 0x2C; |
32 | private const byte CAN_NMT_HEARTBEAT = 0x2C; |
| 33 | 33 | ||
| 34 | private const byte MY_ID = 0x00; |
34 | private const byte MY_ID = 0x00; |
| 35 | //private const byte TARGET_ID = 0x78; |
35 | //private const byte TARGET_ID = 0x78; |
| 36 | private const byte MY_NID = 0x0; |
36 | private const byte MY_NID = 0x0; |
| 37 | private const byte ADDR0_INDEX = 0; |
37 | private const byte ADDR0_INDEX = 0; |
| 38 | private const byte ADDR1_INDEX = 1; |
38 | private const byte ADDR1_INDEX = 1; |
| 39 | private const byte ADDR2_INDEX = 2; |
39 | private const byte ADDR2_INDEX = 2; |
| 40 | private const byte ADDR3_INDEX = 3; |
40 | private const byte ADDR3_INDEX = 3; |
| 41 | 41 | ||
| 42 | private const byte HWID0_INDEX = 4; |
42 | private const byte HWID0_INDEX = 4; |
| 43 | private const byte HWID1_INDEX = 5; |
43 | private const byte HWID1_INDEX = 5; |
| 44 | private const byte HWID2_INDEX = 6; |
44 | private const byte HWID2_INDEX = 6; |
| 45 | private const byte HWID3_INDEX = 7; |
45 | private const byte HWID3_INDEX = 7; |
| 46 | 46 | ||
| 47 | private const int TIMEOUT_MS = 1000; |
47 | private const int TIMEOUT_MS = 1000; |
| 48 | private const int TIMEOUT_SHORT_MS = 200; |
48 | private const int TIMEOUT_SHORT_MS = 200; |
| 49 | 49 | ||
| 50 | private long timeStart = 0; |
50 | private long timeStart = 0; |
| 51 | 51 | ||
| 52 | public Downloader(HexFile hf, DaemonConnection dc, byte receiveID, bool isBiosUpdate, bool HWID_INUSE, uint hwid) { |
52 | public Downloader(HexFile hf, DaemonConnection dc, byte receiveID, bool isBiosUpdate, bool HWID_INUSE, uint hwid) { |
| 53 | this.hf = hf; |
53 | this.hf = hf; |
| 54 | this.dc = dc; |
54 | this.dc = dc; |
| 55 | this.receiveID = receiveID; |
55 | this.receiveID = receiveID; |
| 56 | this.isBiosUpdate = isBiosUpdate; |
56 | this.isBiosUpdate = isBiosUpdate; |
| 57 | this.hwid = hwid; |
57 | this.hwid = hwid; |
| 58 | this.HWID_INUSE = HWID_INUSE; |
58 | this.HWID_INUSE = HWID_INUSE; |
| 59 | } |
59 | } |
| 60 | 60 | ||
| 61 | public int calcCRC(HexFile hf) { |
61 | public int calcCRC(HexFile hf) { |
| 62 | int crc=0; |
62 | int crc=0; |
| 63 | for (ulong i=hf.getAddrLower(); i <= hf.getAddrUpper(); i++) { |
63 | for (ulong i=hf.getAddrLower(); i <= hf.getAddrUpper(); i++) { |
| 64 | crc = crc16_update(crc, hf.getByte(i)); |
64 | crc = crc16_update(crc, hf.getByte(i)); |
| 65 | } |
65 | } |
| 66 | return crc; |
66 | return crc; |
| 67 | } |
67 | } |
| 68 | 68 | ||
| 69 | public int crc16_update(int crc, byte a) { |
69 | public int crc16_update(int crc, byte a) { |
| 70 | int i; |
70 | int i; |
| 71 | crc ^= a; |
71 | crc ^= a; |
| 72 | for (i = 0; i < 8; ++i) { |
72 | for (i = 0; i < 8; ++i) { |
| 73 | if ((crc & 1) != 0) |
73 | if ((crc & 1) != 0) |
| 74 | crc = (crc >> 1) ^ 0xA001; |
74 | crc = (crc >> 1) ^ 0xA001; |
| 75 | else |
75 | else |
| 76 | crc = (crc >> 1); |
76 | crc = (crc >> 1); |
| 77 | } |
77 | } |
| 78 | return crc; |
78 | return crc; |
| 79 | } |
79 | } |
| 80 | 80 | ||
| 81 | public bool go() { |
81 | public bool go() { |
| 82 | if (dc==null || hf==null || hf.getLength()==0) return false; |
82 | if (dc==null || hf==null || hf.getLength()==0) return false; |
| 83 | return downloader(); |
83 | return downloader(); |
| 84 | } |
84 | } |
| 85 | 85 | ||
| 86 | public void abort() { |
86 | public void abort() { |
| 87 | //if (down != null && down.IsAlive) down.Abort(); |
87 | //if (down != null && down.IsAlive) down.Abort(); |
| 88 | } |
88 | } |
| 89 | 89 | ||
| 90 | public bool downloader() { |
90 | public bool downloader() { |
| 91 | dState pgs = dState.SEND_START; |
91 | dState pgs = dState.SEND_START; |
| 92 | int t = 0; |
92 | int t = 0; |
| 93 | int t2 = 0; |
93 | int t2 = 0; |
| 94 | CanPacket outCm = null; |
94 | CanPacket outCm = null; |
| 95 | CanPacket cm = null; |
95 | CanPacket cm = null; |
| 96 | byte[] data = new byte[8]; |
96 | byte[] data = new byte[8]; |
| 97 | uint byteSent = 0; |
97 | uint byteSent = 0; |
| 98 | ulong currentAddress = 0; |
98 | ulong currentAddress = 0; |
| 99 | bool done = false; |
99 | bool done = false; |
| 100 | bool errorOccured = false; |
100 | bool errorOccured = false; |
| - | 101 | ||
| - | 102 | //int rotstate=0; |
|
| - | 103 | int dldisplaystate=0; |
|
| 101 | 104 | ||
| 102 | try { |
105 | try { |
| 103 | if (isBiosUpdate) { |
106 | if (isBiosUpdate) { |
| 104 | dlOffset = hf.getAddrLower(); |
107 | dlOffset = hf.getAddrLower(); |
| 105 | //Console.WriteLine(dlOffset); |
108 | //Console.WriteLine(dlOffset); |
| 106 | //dlOffset = 200; |
109 | //dlOffset = 200; |
| 107 | } |
110 | } |
| 108 | 111 | ||
| 109 | CanNMT cpn = new CanNMT(HWID_INUSE); |
112 | CanNMT cpn = new CanNMT(HWID_INUSE); |
| 110 | cpn.setReceiver(receiveID); |
113 | cpn.setReceiver(receiveID); |
| 111 | bool hasMessage = false; |
114 | bool hasMessage = false; |
| 112 | 115 | ||
| 113 | while (!done) { |
116 | while (!done) { |
| 114 | Thread.Sleep(1); |
117 | Thread.Sleep(1); |
| 115 | 118 | ||
| 116 | switch (pgs) { |
119 | switch (pgs) { |
| 117 | case dState.SEND_START: |
120 | case dState.SEND_START: |
| 118 | // Send boot start packet to target. |
121 | // Send boot start packet to target. |
| 119 | // and wait for ack. |
122 | // and wait for ack. |
| 120 | currentAddress = hf.getAddrLower(); |
123 | currentAddress = hf.getAddrLower(); |
| 121 | //data[RID_INDEX] = TARGET_ID; |
124 | //data[RID_INDEX] = TARGET_ID; |
| 122 | data[ADDR0_INDEX] = (byte)((currentAddress-dlOffset) & 0x0000FF); |
125 | data[ADDR0_INDEX] = (byte)((currentAddress-dlOffset) & 0x0000FF); |
| 123 | data[ADDR1_INDEX] = (byte)(((currentAddress-dlOffset) & 0x00FF00) >> 8); |
126 | data[ADDR1_INDEX] = (byte)(((currentAddress-dlOffset) & 0x00FF00) >> 8); |
| 124 | data[ADDR2_INDEX] = (byte)(((currentAddress-dlOffset) & 0xFF0000) >> 16); |
127 | data[ADDR2_INDEX] = (byte)(((currentAddress-dlOffset) & 0xFF0000) >> 16); |
| 125 | data[ADDR3_INDEX] = 0; |
128 | data[ADDR3_INDEX] = 0; |
| 126 | if (HWID_INUSE) { |
129 | if (HWID_INUSE) { |
| 127 | data[HWID0_INDEX] = (byte)((hwid) & 0xFF); |
130 | data[HWID0_INDEX] = (byte)((hwid) & 0xFF); |
| 128 | data[HWID1_INDEX] = (byte)((hwid>>8) & 0xFF); |
131 | data[HWID1_INDEX] = (byte)((hwid>>8) & 0xFF); |
| 129 | data[HWID2_INDEX] = (byte)((hwid>>16) & 0xFF); |
132 | data[HWID2_INDEX] = (byte)((hwid>>16) & 0xFF); |
| 130 | data[HWID3_INDEX] = (byte)((hwid>>24) & 0xFF); |
133 | data[HWID3_INDEX] = (byte)((hwid>>24) & 0xFF); |
| 131 | } |
134 | } |
| 132 | //outCm = new CanPacket(CAN_NMT, CAN_NMT_PGM_START, MY_ID, receiveID, 4, data); |
135 | //outCm = new CanPacket(CAN_NMT, CAN_NMT_PGM_START, MY_ID, receiveID, 4, data); |
| 133 | outCm = cpn.getPgmStartPacket(data); |
136 | outCm = cpn.getPgmStartPacket(data); |
| 134 | dc.sendCanPacket(outCm); |
137 | dc.sendCanPacket(outCm); |
| 135 | t = Environment.TickCount; |
138 | t = Environment.TickCount; |
| 136 | t2 = Environment.TickCount; |
139 | t2 = Environment.TickCount; |
| 137 | pgs = dState.WAIT_ACK_PRG; |
140 | pgs = dState.WAIT_ACK_PRG; |
| 138 | timeStart = Environment.TickCount; |
141 | timeStart = Environment.TickCount; |
| - | 142 | Console.WriteLine("Downloading..."); |
|
| 139 | break; |
143 | break; |
| 140 | 144 | ||
| 141 | 145 | ||
| 142 | case dState.WAIT_ACK_PRG: |
146 | case dState.WAIT_ACK_PRG: |
| 143 | // Check for timeout, resend start packet in that case.. |
147 | // Check for timeout, resend start packet in that case.. |
| 144 | if ((Environment.TickCount - t) > TIMEOUT_MS) { |
148 | if ((Environment.TickCount - t) > TIMEOUT_MS) { |
| 145 | Console.WriteLine("Timeout while waiting for start prg ack."); |
149 | Console.WriteLine("Timeout while waiting for start prg ack."); |
| 146 | errorOccured = true; |
150 | errorOccured = true; |
| 147 | pgs = dState.SEND_RESET; |
151 | pgs = dState.SEND_RESET; |
| 148 | } |
152 | } |
| 149 | //Thread.Sleep(1); |
153 | //Thread.Sleep(1); |
| 150 | // If received ack. |
154 | // If received ack. |
| 151 | hasMessage = dc.getData(out cm); |
155 | hasMessage = dc.getData(out cm); |
| 152 | if (hasMessage) { |
156 | if (hasMessage) { |
| 153 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
157 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
| 154 | if (cpnin.isNMTPacket()) { |
158 | if (cpnin.isNMTPacket()) { |
| 155 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
159 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
| 156 | // If no error |
160 | // If no error |
| 157 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
161 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
| 158 | // Start sending program data.. |
162 | // Start sending program data.. |
| 159 | byteSent = 0; |
163 | byteSent = 0; |
| 160 | pgs = dState.SEND_PGM_DATA; |
164 | pgs = dState.SEND_PGM_DATA; |
| 161 | } |
165 | } |
| 162 | else if (cpnin.getType() == CAN_NMT_PGM_NACK ) { |
166 | else if (cpnin.getType() == CAN_NMT_PGM_NACK ) { |
| 163 | // else .. |
167 | // else .. |
| 164 | Console.WriteLine("Nack on CAN_NMT_PGM_START."); |
168 | Console.WriteLine("Nack on CAN_NMT_PGM_START."); |
| 165 | errorOccured = true; |
169 | errorOccured = true; |
| 166 | pgs = dState.SEND_RESET; |
170 | pgs = dState.SEND_RESET; |
| 167 | } |
171 | } |
| 168 | } |
172 | } |
| 169 | } |
173 | } |
| 170 | break; |
174 | break; |
| 171 | 175 | ||
| 172 | case dState.SEND_PGM_DATA: |
176 | case dState.SEND_PGM_DATA: |
| 173 | //Console.WriteLine("byteSent = "+byteSent); |
177 | //Console.WriteLine("byteSent = "+byteSent); |
| - | 178 | //disable Console.Write("."); |
|
| - | 179 | //Console.Write("\b"); |
|
| - | 180 | //int curleft = Console.CursorLeft; |
|
| - | 181 | //int curtop = Console.CursorTop; |
|
| - | 182 | //Console.SetCursorPosition(curleft, curtop-1); |
|
| - | 183 | ||
| - | 184 | //if (rotstate==0) { |
|
| 174 |
|
185 | // Console.Write("-"); |
| - | 186 | // rotstate=1; |
|
| - | 187 | //} else if (rotstate==1) { |
|
| - | 188 | // Console.Write("\\"); |
|
| - | 189 | // rotstate=2; |
|
| - | 190 | //} else if (rotstate==2) { |
|
| - | 191 | // Console.Write("|"); |
|
| - | 192 | // rotstate=3; |
|
| - | 193 | //} else if (rotstate==3) { |
|
| - | 194 | // Console.Write("/"); |
|
| - | 195 | // rotstate=0; |
|
| - | 196 | //} |
|
| - | 197 | //Console.Write("\r"); |
|
| - | 198 | //dldisplaystate |
|
| - | 199 | ||
| - | 200 | //FULHACK deulx |
|
| - | 201 | ulong percent = byteSent*100/(hf.getAddrUpper()-currentAddress); |
|
| - | 202 | ||
| - | 203 | if (percent>9 && dldisplaystate==0) { |
|
| - | 204 | Console.Write("\r"); |
|
| - | 205 | Console.Write(percent+"%"); |
|
| - | 206 | dldisplaystate=1; |
|
| - | 207 | } else if (percent>19 && dldisplaystate==1) { |
|
| - | 208 | Console.Write("\r"); |
|
| - | 209 | Console.Write(percent+"%"); |
|
| - | 210 | dldisplaystate=2; |
|
| - | 211 | } else if (percent>29 && dldisplaystate==2) { |
|
| - | 212 | Console.Write("\r"); |
|
| - | 213 | Console.Write(percent+"%"); |
|
| - | 214 | dldisplaystate=3; |
|
| - | 215 | } else if (percent>39 && dldisplaystate==3) { |
|
| - | 216 | Console.Write("\r"); |
|
| - | 217 | Console.Write(percent+"%"); |
|
| - | 218 | dldisplaystate=4; |
|
| - | 219 | } else if (percent>49 && dldisplaystate==4) { |
|
| - | 220 | Console.Write("\r"); |
|
| - | 221 | Console.Write(percent+"%"); |
|
| - | 222 | dldisplaystate=5; |
|
| - | 223 | } else if (percent>59 && dldisplaystate==5) { |
|
| - | 224 | Console.Write("\r"); |
|
| - | 225 | Console.Write(percent+"%"); |
|
| - | 226 | dldisplaystate=6; |
|
| - | 227 | } else if (percent>69 && dldisplaystate==6) { |
|
| - | 228 | Console.Write("\r"); |
|
| - | 229 | Console.Write(percent+"%"); |
|
| - | 230 | dldisplaystate=7; |
|
| - | 231 | } else if (percent>79 && dldisplaystate==7) { |
|
| - | 232 | Console.Write("\r"); |
|
| - | 233 | Console.Write(percent+"%"); |
|
| - | 234 | dldisplaystate=8; |
|
| - | 235 | } else if (percent>89 && dldisplaystate==8) { |
|
| - | 236 | Console.Write("\r"); |
|
| - | 237 | Console.Write(percent+"%"); |
|
| - | 238 | dldisplaystate=9; |
|
| - | 239 | } else if (percent>99 && dldisplaystate==9) { |
|
| - | 240 | Console.Write("\r"); |
|
| - | 241 | Console.Write(percent+"%"); |
|
| - | 242 | dldisplaystate=10; |
|
| - | 243 | } |
|
| - | 244 | ||
| 175 | // Send program data. |
245 | // Send program data. |
| 176 | byte datalength = 2; |
246 | byte datalength = 2; |
| 177 | for (ulong i = 0; i < 6; i++) { |
247 | for (ulong i = 0; i < 6; i++) { |
| 178 | // Populate data. |
248 | // Populate data. |
| 179 | data[i+2] = hf.getByte(currentAddress + i + byteSent); |
249 | data[i+2] = hf.getByte(currentAddress + i + byteSent); |
| 180 | if (currentAddress + i + byteSent > hf.getAddrUpper()) { |
250 | if (currentAddress + i + byteSent > hf.getAddrUpper()) { |
| 181 | break; //then done |
251 | break; //then done |
| 182 | } |
252 | } |
| 183 | datalength++; |
253 | datalength++; |
| 184 | } |
254 | } |
| 185 | data[0] = (byte)(byteSent & 0x00FF); |
255 | data[0] = (byte)(byteSent & 0x00FF); |
| 186 | data[1] = (byte)((byteSent & 0xFF00) >> 8); |
256 | data[1] = (byte)((byteSent & 0xFF00) >> 8); |
| 187 | 257 | ||
| 188 | outCm = cpn.getPgmDataPacket(data, datalength); |
258 | outCm = cpn.getPgmDataPacket(data, datalength); |
| 189 | dc.sendCanPacket(outCm); |
259 | dc.sendCanPacket(outCm); |
| 190 | 260 | ||
| 191 | t = Environment.TickCount; |
261 | t = Environment.TickCount; |
| 192 | t2 = Environment.TickCount; |
262 | t2 = Environment.TickCount; |
| 193 | byteSent += 6; |
263 | byteSent += 6; |
| 194 | pgs = dState.WAIT_ACK_DATA; |
264 | pgs = dState.WAIT_ACK_DATA; |
| 195 | break; |
265 | break; |
| 196 | 266 | ||
| 197 | 267 | ||
| 198 | case dState.WAIT_ACK_DATA: |
268 | case dState.WAIT_ACK_DATA: |
| 199 | // Wait for pgm ack. |
269 | // Wait for pgm ack. |
| 200 | if ((Environment.TickCount - t) > TIMEOUT_MS) { |
270 | if ((Environment.TickCount - t) > TIMEOUT_MS) { |
| 201 | // Woops, error. |
271 | // Woops, error. |
| 202 | Console.WriteLine("Timeout while waiting for data ack."); |
272 | Console.WriteLine("Timeout while waiting for data ack."); |
| 203 | errorOccured = true; |
273 | errorOccured = true; |
| 204 | pgs = dState.SEND_RESET; |
274 | pgs = dState.SEND_RESET; |
| 205 | } |
275 | } |
| 206 | else if ((Environment.TickCount - t2) > TIMEOUT_SHORT_MS) { |
276 | else if ((Environment.TickCount - t2) > TIMEOUT_SHORT_MS) { |
| 207 | // Woops, error. |
277 | // Woops, error. |
| 208 |
|
278 | //disable Console.Write(":"); |
| 209 | byteSent -= 6; |
279 | byteSent -= 6; |
| 210 | pgs = dState.SEND_PGM_DATA; |
280 | pgs = dState.SEND_PGM_DATA; |
| 211 | break; |
281 | break; |
| 212 | } |
282 | } |
| 213 | //Thread.Sleep(1); |
283 | //Thread.Sleep(1); |
| 214 | // If received ack. |
284 | // If received ack. |
| 215 | hasMessage = dc.getData(out cm); |
285 | hasMessage = dc.getData(out cm); |
| 216 | if (hasMessage) { |
286 | if (hasMessage) { |
| 217 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
287 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
| 218 | if (cpnin.isNMTPacket()) { |
288 | if (cpnin.isNMTPacket()) { |
| 219 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
289 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
| 220 | // If no error |
290 | // If no error |
| 221 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
291 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
| 222 | //currentAddress += 2; |
292 | //currentAddress += 2; |
| 223 | // Check if end. |
293 | // Check if end. |
| 224 | if (currentAddress + byteSent > hf.getAddrUpper()) { |
294 | if (currentAddress + byteSent > hf.getAddrUpper()) { |
| 225 | // Yes, we are done, send done. |
295 | // Yes, we are done, send done. |
| 226 | pgs = dState.SEND_DONE; |
296 | pgs = dState.SEND_DONE; |
| 227 | } |
297 | } |
| 228 | else { |
298 | else { |
| 229 | // More to write. |
299 | // More to write. |
| 230 | //byteSent = 0; |
300 | //byteSent = 0; |
| 231 | pgs = dState.SEND_PGM_DATA; |
301 | pgs = dState.SEND_PGM_DATA; |
| 232 | } |
302 | } |
| 233 | } |
303 | } |
| 234 | else if (cpnin.getType() == CAN_NMT_PGM_NACK ) { |
304 | else if (cpnin.getType() == CAN_NMT_PGM_NACK ) { |
| 235 | // else .. |
305 | // else .. |
| 236 | Console.WriteLine("Nack on CAN_NMT_PGM_DATA."); |
306 | Console.WriteLine("Nack on CAN_NMT_PGM_DATA."); |
| 237 | errorOccured = true; |
307 | errorOccured = true; |
| 238 | pgs = dState.SEND_RESET; |
308 | pgs = dState.SEND_RESET; |
| 239 | } |
309 | } |
| 240 | } |
310 | } |
| 241 | } |
311 | } |
| 242 | break; |
312 | break; |
| 243 | 313 | ||
| 244 | case dState.SEND_DONE: |
314 | case dState.SEND_DONE: |
| - | 315 | Console.Write("\r"); |
|
| - | 316 | Console.Write("100%"); |
|
| 245 | // Send done |
317 | // Send done |
| 246 | outCm = cpn.getPgmEndPacket(); |
318 | outCm = cpn.getPgmEndPacket(); |
| 247 | dc.sendCanPacket(outCm); |
319 | dc.sendCanPacket(outCm); |
| 248 | 320 | ||
| 249 | t = Environment.TickCount; |
321 | t = Environment.TickCount; |
| 250 | t2 = Environment.TickCount; |
322 | t2 = Environment.TickCount; |
| 251 | pgs = dState.WAIT_DONE; |
323 | pgs = dState.WAIT_DONE; |
| 252 | break; |
324 | break; |
| 253 | 325 | ||
| 254 | 326 | ||
| 255 | case dState.WAIT_DONE: |
327 | case dState.WAIT_DONE: |
| 256 | // Check for timeout, resend done packet in that case.. |
328 | // Check for timeout, resend done packet in that case.. |
| 257 | if ((Environment.TickCount - t) > TIMEOUT_MS) { |
329 | if ((Environment.TickCount - t) > TIMEOUT_MS) { |
| 258 | Console.WriteLine("Timeout while waiting for end prg ack."); |
330 | Console.WriteLine("Timeout while waiting for end prg ack."); |
| 259 | errorOccured = true; |
331 | errorOccured = true; |
| 260 | pgs = dState.SEND_RESET; |
332 | pgs = dState.SEND_RESET; |
| 261 | } |
333 | } |
| 262 | //Thread.Sleep(1); |
334 | //Thread.Sleep(1); |
| 263 | 335 | ||
| 264 | hasMessage = dc.getData(out cm); |
336 | hasMessage = dc.getData(out cm); |
| 265 | if (hasMessage) { |
337 | if (hasMessage) { |
| 266 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
338 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
| 267 | if (cpnin.isNMTPacket()) { |
339 | if (cpnin.isNMTPacket()) { |
| 268 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
340 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
| 269 | // If no error |
341 | // If no error |
| 270 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
342 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
| 271 | Console.WriteLine(""); |
343 | Console.WriteLine(""); |
| 272 | // |
344 | // |
| 273 | int crc = calcCRC(hf); |
345 | int crc = calcCRC(hf); |
| 274 | 346 | ||
| 275 | if (cm.getDataLength() == 2) { |
347 | if (cm.getDataLength() == 2) { |
| 276 | byte[] cmdata = cm.getData(); |
348 | byte[] cmdata = cm.getData(); |
| 277 | if ((cmdata[0] == (crc & 0xFF)) && (cmdata[1] == (crc>>8))) { |
349 | if ((cmdata[0] == (crc & 0xFF)) && (cmdata[1] == (crc>>8))) { |
| 278 | if (!isBiosUpdate) { |
350 | if (!isBiosUpdate) { |
| 279 | Console.WriteLine("Done, successfully programmed application."); |
351 | Console.WriteLine("Done, successfully programmed application."); |
| 280 | pgs = dState.SEND_RESET; |
352 | pgs = dState.SEND_RESET; |
| 281 | } else { |
353 | } else { |
| 282 | Console.WriteLine("Done, successfully programmed bios to application space."); |
354 | Console.WriteLine("Done, successfully programmed bios to application space."); |
| 283 | pgs = dState.SEND_BIOS_UPDATE; |
355 | pgs = dState.SEND_BIOS_UPDATE; |
| 284 | } |
356 | } |
| 285 | } else { |
357 | } else { |
| 286 | string nodecrc = String.Format("{0:x4}", (int)cmdata[0] + (int)(cmdata[1]<<8)); |
358 | string nodecrc = String.Format("{0:x4}", (int)cmdata[0] + (int)(cmdata[1]<<8)); |
| 287 | nodecrc = "0x"+nodecrc; |
359 | nodecrc = "0x"+nodecrc; |
| 288 | string realcrc = String.Format("{0:x4}", (int)(crc & 0xFF) + (int)(crc & 0xFF00)); |
360 | string realcrc = String.Format("{0:x4}", (int)(crc & 0xFF) + (int)(crc & 0xFF00)); |
| 289 | realcrc = "0x"+realcrc; |
361 | realcrc = "0x"+realcrc; |
| 290 | Console.WriteLine("CRC failed. Node sent CRC "+nodecrc+" but should be "+realcrc+"."); |
362 | Console.WriteLine("CRC failed. Node sent CRC "+nodecrc+" but should be "+realcrc+"."); |
| 291 | errorOccured = true; |
363 | errorOccured = true; |
| 292 | pgs = dState.SEND_RESET; |
364 | pgs = dState.SEND_RESET; |
| 293 | } |
365 | } |
| 294 | 366 | ||
| 295 | byteSent = 0; |
367 | byteSent = 0; |
| 296 | } |
368 | } |
| 297 | //Console.WriteLine("crc: " + crc + " " + (crc>>8) + " " + (crc & 0xFF)); |
369 | //Console.WriteLine("crc: " + crc + " " + (crc>>8) + " " + (crc & 0xFF)); |
| 298 | //Console.WriteLine("ACKpkg with CRC: " + cm.ToString()); |
370 | //Console.WriteLine("ACKpkg with CRC: " + cm.ToString()); |
| 299 | // |
371 | // |
| 300 | } |
372 | } |
| 301 | else if (cpnin.getType() == CAN_NMT_PGM_NACK) { |
373 | else if (cpnin.getType() == CAN_NMT_PGM_NACK) { |
| 302 | // else resend addr.. |
374 | // else resend addr.. |
| 303 | Console.WriteLine("Nack on CAN_NMT_PGM_END."); |
375 | Console.WriteLine("Nack on CAN_NMT_PGM_END."); |
| 304 | errorOccured = true; |
376 | errorOccured = true; |
| 305 | pgs = dState.SEND_RESET; |
377 | pgs = dState.SEND_RESET; |
| 306 | } |
378 | } |
| 307 | } |
379 | } |
| 308 | } |
380 | } |
| 309 | break; |
381 | break; |
| 310 | 382 | ||
| 311 | case dState.SEND_BIOS_UPDATE: |
383 | case dState.SEND_BIOS_UPDATE: |
| 312 | data[0] = (byte)(0 & 0x00FF); |
384 | data[0] = (byte)(0 & 0x00FF); |
| 313 | data[1] = (byte)((0 & 0xFF00) >> 8); |
385 | data[1] = (byte)((0 & 0xFF00) >> 8); |
| 314 | data[2] = (byte)(dlOffset & 0x00FF); |
386 | data[2] = (byte)(dlOffset & 0x00FF); |
| 315 | data[3] = (byte)((dlOffset & 0xFF00) >> 8); |
387 | data[3] = (byte)((dlOffset & 0xFF00) >> 8); |
| 316 | data[4] = (byte)((hf.getAddrUpper()-hf.getAddrLower()+1) & 0x00FF); |
388 | data[4] = (byte)((hf.getAddrUpper()-hf.getAddrLower()+1) & 0x00FF); |
| 317 | data[5] = (byte)(((hf.getAddrUpper()-hf.getAddrLower()+1) & 0xFF00) >> 8); |
389 | data[5] = (byte)(((hf.getAddrUpper()-hf.getAddrLower()+1) & 0xFF00) >> 8); |
| 318 | 390 | ||
| 319 | outCm = cpn.getPgmCopyPacket(data); |
391 | outCm = cpn.getPgmCopyPacket(data); |
| 320 | Console.WriteLine("Now say a prayer, moving bios"); |
392 | Console.WriteLine("Now say a prayer, moving bios"); |
| 321 | dc.sendCanPacket(outCm); |
393 | dc.sendCanPacket(outCm); |
| 322 | t = Environment.TickCount; |
394 | t = Environment.TickCount; |
| 323 | t2 = Environment.TickCount; |
395 | t2 = Environment.TickCount; |
| 324 | pgs = dState.WAIT_BOOT; |
396 | pgs = dState.WAIT_BOOT; |
| 325 | //pgs = dState.DONE; |
397 | //pgs = dState.DONE; |
| 326 | break; |
398 | break; |
| 327 | 399 | ||
| 328 | case dState.WAIT_BOOT: |
400 | case dState.WAIT_BOOT: |
| 329 | // Wait for node reset answer (boot msg). |
401 | // Wait for node reset answer (boot msg). |
| 330 | if ((Environment.TickCount - t) > 3*TIMEOUT_MS) { |
402 | if ((Environment.TickCount - t) > 3*TIMEOUT_MS) { |
| 331 | // Woops, error. |
403 | // Woops, error. |
| 332 | Console.WriteLine("Timeout while waiting for node to boot."); |
404 | Console.WriteLine("Timeout while waiting for node to boot."); |
| 333 | errorOccured = true; |
405 | errorOccured = true; |
| 334 | pgs = dState.SEND_DONE; |
406 | pgs = dState.SEND_DONE; |
| 335 | } |
407 | } |
| 336 | //Thread.Sleep(1); |
408 | //Thread.Sleep(1); |
| 337 | // If received boot msg. |
409 | // If received boot msg. |
| 338 | hasMessage = dc.getData(out cm); |
410 | hasMessage = dc.getData(out cm); |
| 339 | if (hasMessage) { |
411 | if (hasMessage) { |
| 340 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
412 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
| 341 | if (cpnin.isNMTPacket()) { |
413 | if (cpnin.isNMTPacket()) { |
| 342 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
414 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
| 343 | // If no error |
415 | // If no error |
| 344 | if (cpnin.getType() == CAN_NMT_BIOS_START) { |
416 | if (cpnin.getType() == CAN_NMT_BIOS_START) { |
| 345 | pgs = dState.SEND_EMPTY_START; |
417 | pgs = dState.SEND_EMPTY_START; |
| 346 | } |
418 | } |
| 347 | else { |
419 | else { |
| 348 | // else .. |
420 | // else .. |
| 349 | } |
421 | } |
| 350 | } |
422 | } |
| 351 | } |
423 | } |
| 352 | break; |
424 | break; |
| 353 | 425 | ||
| 354 | case dState.SEND_EMPTY_START: |
426 | case dState.SEND_EMPTY_START: |
| 355 | // Send boot start packet to target. |
427 | // Send boot start packet to target. |
| 356 | // and wait for ack. |
428 | // and wait for ack. |
| 357 | 429 | ||
| 358 | //data[RID_INDEX] = TARGET_ID; |
430 | //data[RID_INDEX] = TARGET_ID; |
| 359 | data[ADDR0_INDEX] = (byte)((0) & 0x0000FF); |
431 | data[ADDR0_INDEX] = (byte)((0) & 0x0000FF); |
| 360 | data[ADDR1_INDEX] = (byte)(((0) & 0x00FF00) >> 8); |
432 | data[ADDR1_INDEX] = (byte)(((0) & 0x00FF00) >> 8); |
| 361 | data[ADDR2_INDEX] = (byte)(((0) & 0xFF0000) >> 16); |
433 | data[ADDR2_INDEX] = (byte)(((0) & 0xFF0000) >> 16); |
| 362 | data[ADDR3_INDEX] = 0; |
434 | data[ADDR3_INDEX] = 0; |
| 363 | if (HWID_INUSE) { |
435 | if (HWID_INUSE) { |
| 364 | data[HWID0_INDEX] = (byte)((hwid) & 0xFF); |
436 | data[HWID0_INDEX] = (byte)((hwid) & 0xFF); |
| 365 | data[HWID1_INDEX] = (byte)((hwid>>8) & 0xFF); |
437 | data[HWID1_INDEX] = (byte)((hwid>>8) & 0xFF); |
| 366 | data[HWID2_INDEX] = (byte)((hwid>>16) & 0xFF); |
438 | data[HWID2_INDEX] = (byte)((hwid>>16) & 0xFF); |
| 367 | data[HWID3_INDEX] = (byte)((hwid>>24) & 0xFF); |
439 | data[HWID3_INDEX] = (byte)((hwid>>24) & 0xFF); |
| 368 | } |
440 | } |
| 369 | //outCm = new CanPacket(CAN_NMT, CAN_NMT_PGM_START, MY_ID, receiveID, 4, data); |
441 | //outCm = new CanPacket(CAN_NMT, CAN_NMT_PGM_START, MY_ID, receiveID, 4, data); |
| 370 | outCm = cpn.getPgmStartPacket(data); |
442 | outCm = cpn.getPgmStartPacket(data); |
| 371 | dc.sendCanPacket(outCm); |
443 | dc.sendCanPacket(outCm); |
| 372 | t = Environment.TickCount; |
444 | t = Environment.TickCount; |
| 373 | t2 = Environment.TickCount; |
445 | t2 = Environment.TickCount; |
| 374 | pgs = dState.WAIT_ACK_PRG_EMPTY; |
446 | pgs = dState.WAIT_ACK_PRG_EMPTY; |
| 375 | break; |
447 | break; |
| 376 | 448 | ||
| 377 | 449 | ||
| 378 | case dState.WAIT_ACK_PRG_EMPTY: |
450 | case dState.WAIT_ACK_PRG_EMPTY: |
| 379 | // Check for timeout, resend start packet in that case.. |
451 | // Check for timeout, resend start packet in that case.. |
| 380 | if ((Environment.TickCount - t) > 3*TIMEOUT_MS) { |
452 | if ((Environment.TickCount - t) > 3*TIMEOUT_MS) { |
| 381 | Console.WriteLine("Timeout while waiting for start prg ack during empty-first-block-cycle."); |
453 | Console.WriteLine("Timeout while waiting for start prg ack during empty-first-block-cycle."); |
| 382 | errorOccured = true; |
454 | errorOccured = true; |
| 383 | pgs = dState.SEND_RESET; |
455 | pgs = dState.SEND_RESET; |
| 384 | } |
456 | } |
| 385 | //Thread.Sleep(1); |
457 | //Thread.Sleep(1); |
| 386 | // If received ack. |
458 | // If received ack. |
| 387 | hasMessage = dc.getData(out cm); |
459 | hasMessage = dc.getData(out cm); |
| 388 | if (hasMessage) { |
460 | if (hasMessage) { |
| 389 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
461 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
| 390 | if (cpnin.isNMTPacket()) { |
462 | if (cpnin.isNMTPacket()) { |
| 391 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
463 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
| 392 | // If no error |
464 | // If no error |
| 393 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
465 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
| 394 | // Start sending program data.. |
466 | // Start sending program data.. |
| 395 | byteSent = 0; |
467 | byteSent = 0; |
| 396 | pgs = dState.SEND_EMPTY_DATA; |
468 | pgs = dState.SEND_EMPTY_DATA; |
| 397 | } |
469 | } |
| 398 | else if (cpnin.getType() == CAN_NMT_PGM_NACK ) { |
470 | else if (cpnin.getType() == CAN_NMT_PGM_NACK ) { |
| 399 | // else .. |
471 | // else .. |
| 400 | Console.WriteLine("Nack on CAN_NMT_PGM_START."); |
472 | Console.WriteLine("Nack on CAN_NMT_PGM_START."); |
| 401 | errorOccured = true; |
473 | errorOccured = true; |
| 402 | pgs = dState.SEND_RESET; |
474 | pgs = dState.SEND_RESET; |
| 403 | } |
475 | } |
| 404 | } |
476 | } |
| 405 | } |
477 | } |
| 406 | break; |
478 | break; |
| 407 | 479 | ||
| 408 | case dState.SEND_EMPTY_DATA: |
480 | case dState.SEND_EMPTY_DATA: |
| 409 | // Send program data. |
481 | // Send program data. |
| 410 | data[0] = 0; |
482 | data[0] = 0; |
| 411 | data[1] = 0; |
483 | data[1] = 0; |
| 412 | data[2] = 0xff; |
484 | data[2] = 0xff; |
| 413 | data[3] = 0xff; |
485 | data[3] = 0xff; |
| 414 | 486 | ||
| 415 | outCm = cpn.getPgmDataPacket(data, 4); |
487 | outCm = cpn.getPgmDataPacket(data, 4); |
| 416 | dc.sendCanPacket(outCm); |
488 | dc.sendCanPacket(outCm); |
| 417 | 489 | ||
| 418 | t = Environment.TickCount; |
490 | t = Environment.TickCount; |
| 419 | t2 = Environment.TickCount; |
491 | t2 = Environment.TickCount; |
| 420 | byteSent += 6; |
492 | byteSent += 6; |
| 421 | pgs = dState.WAIT_ACK_EMPTY_DATA; |
493 | pgs = dState.WAIT_ACK_EMPTY_DATA; |
| 422 | break; |
494 | break; |
| 423 | 495 | ||
| 424 | 496 | ||
| 425 | case dState.WAIT_ACK_EMPTY_DATA: |
497 | case dState.WAIT_ACK_EMPTY_DATA: |
| 426 | // Wait for pgm ack. |
498 | // Wait for pgm ack. |
| 427 | if ((Environment.TickCount - t) > 2*TIMEOUT_MS) { |
499 | if ((Environment.TickCount - t) > 2*TIMEOUT_MS) { |
| 428 | // Woops, error. |
500 | // Woops, error. |
| 429 | Console.WriteLine("Timeout while waiting for data ack."); |
501 | Console.WriteLine("Timeout while waiting for data ack."); |
| 430 | errorOccured = true; |
502 | errorOccured = true; |
| 431 | pgs = dState.SEND_RESET; |
503 | pgs = dState.SEND_RESET; |
| 432 | } |
504 | } |
| 433 | //Thread.Sleep(1); |
505 | //Thread.Sleep(1); |
| 434 | // If received ack. |
506 | // If received ack. |
| 435 | hasMessage = dc.getData(out cm); |
507 | hasMessage = dc.getData(out cm); |
| 436 | if (hasMessage) { |
508 | if (hasMessage) { |
| 437 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
509 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
| 438 | if (cpnin.isNMTPacket()) { |
510 | if (cpnin.isNMTPacket()) { |
| 439 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
511 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
| 440 | // If no error |
512 | // If no error |
| 441 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
513 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
| 442 | pgs = dState.SEND_DONE_EMPTY; |
514 | pgs = dState.SEND_DONE_EMPTY; |
| 443 | } |
515 | } |
| 444 | else if (cpnin.getType() == CAN_NMT_PGM_NACK ) { |
516 | else if (cpnin.getType() == CAN_NMT_PGM_NACK ) { |
| 445 | // else .. |
517 | // else .. |
| 446 | Console.WriteLine("Nack on CAN_NMT_PGM_DATA."); |
518 | Console.WriteLine("Nack on CAN_NMT_PGM_DATA."); |
| 447 | errorOccured = true; |
519 | errorOccured = true; |
| 448 | pgs = dState.SEND_RESET; |
520 | pgs = dState.SEND_RESET; |
| 449 | } |
521 | } |
| 450 | } |
522 | } |
| 451 | } |
523 | } |
| 452 | break; |
524 | break; |
| 453 | 525 | ||
| 454 | case dState.SEND_DONE_EMPTY: |
526 | case dState.SEND_DONE_EMPTY: |
| 455 | // Send done |
527 | // Send done |
| 456 | outCm = cpn.getPgmEndPacket(); |
528 | outCm = cpn.getPgmEndPacket(); |
| 457 | dc.sendCanPacket(outCm); |
529 | dc.sendCanPacket(outCm); |
| 458 | 530 | ||
| 459 | t = Environment.TickCount; |
531 | t = Environment.TickCount; |
| 460 | t2 = Environment.TickCount; |
532 | t2 = Environment.TickCount; |
| 461 | pgs = dState.WAIT_DONE_EMPTY; |
533 | pgs = dState.WAIT_DONE_EMPTY; |
| 462 | break; |
534 | break; |
| 463 | 535 | ||
| 464 | 536 | ||
| 465 | case dState.WAIT_DONE_EMPTY: |
537 | case dState.WAIT_DONE_EMPTY: |
| 466 | // Check for timeout, resend done packet in that case.. |
538 | // Check for timeout, resend done packet in that case.. |
| 467 | if ((Environment.TickCount - t) > TIMEOUT_MS) { |
539 | if ((Environment.TickCount - t) > TIMEOUT_MS) { |
| 468 | Console.WriteLine("Timeout while waiting for end prg ack."); |
540 | Console.WriteLine("Timeout while waiting for end prg ack."); |
| 469 | errorOccured = true; |
541 | errorOccured = true; |
| 470 | pgs = dState.SEND_RESET; |
542 | pgs = dState.SEND_RESET; |
| 471 | } |
543 | } |
| 472 | //Thread.Sleep(1); |
544 | //Thread.Sleep(1); |
| 473 | 545 | ||
| 474 | hasMessage = dc.getData(out cm); |
546 | hasMessage = dc.getData(out cm); |
| 475 | if (hasMessage) { |
547 | if (hasMessage) { |
| 476 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
548 | CanNMT cpnin = new CanNMT(cm, HWID_INUSE); |
| 477 | if (cpnin.isNMTPacket()) { |
549 | if (cpnin.isNMTPacket()) { |
| 478 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
550 | //if (cpnin.isNMTPacket() && (cpnin.getSender() == receiveID)) { |
| 479 | // If no error |
551 | // If no error |
| 480 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
552 | if (cpnin.getType() == CAN_NMT_PGM_ACK) { |
| 481 | Console.WriteLine(""); |
553 | Console.WriteLine(""); |
| 482 | // |
554 | // |
| 483 | Console.WriteLine("Done, successfully cleaned application flash."); |
555 | Console.WriteLine("Done, successfully cleaned application flash."); |
| 484 | pgs = dState.SEND_RESET; |
556 | pgs = dState.SEND_RESET; |
| 485 | } |
557 | } |
| 486 | else if (cpnin.getType() == CAN_NMT_PGM_NACK) { |
558 | else if (cpnin.getType() == CAN_NMT_PGM_NACK) { |
| 487 | // else resend addr.. |
559 | // else resend addr.. |
| 488 | Console.WriteLine("Nack on CAN_NMT_PGM_END."); |
560 | Console.WriteLine("Nack on CAN_NMT_PGM_END."); |
| 489 | errorOccured = true; |
561 | errorOccured = true; |
| 490 | pgs = dState.SEND_RESET; |
562 | pgs = dState.SEND_RESET; |
| 491 | } |
563 | } |
| 492 | } |
564 | } |
| 493 | } |
565 | } |
| 494 | break; |
566 | break; |
| 495 | case dState.SEND_RESET: |
567 | case dState.SEND_RESET: |
| 496 | // Send reset |
568 | // Send reset |
| 497 | cpn.doReset(dc, receiveID, hwid); |
569 | cpn.doReset(dc, receiveID, hwid); |
| 498 | t = Environment.TickCount; |
570 | t = Environment.TickCount; |
| 499 | t2 = Environment.TickCount; |
571 | t2 = Environment.TickCount; |
| 500 | pgs = dState.DONE; |
572 | pgs = dState.DONE; |
| 501 | break; |
573 | break; |
| 502 | 574 | ||
| 503 | 575 | ||
| 504 | case dState.DONE: |
576 | case dState.DONE: |
| 505 | done = true; |
577 | done = true; |
| 506 | //down.Abort(); |
578 | //down.Abort(); |
| 507 | if (!errorOccured) { |
579 | if (!errorOccured) { |
| 508 | long tsecs = ((Environment.TickCount - timeStart) / 1000); |
580 | long tsecs = ((Environment.TickCount - timeStart) / 1000); |
| 509 | double bitRate = hf.getLength() / ((double)(Environment.TickCount - timeStart) / 1000.0); |
581 | double bitRate = hf.getLength() / ((double)(Environment.TickCount - timeStart) / 1000.0); |
| 510 | 582 | ||
| 511 | if (tsecs <= 0) tsecs = 1; |
583 | if (tsecs <= 0) tsecs = 1; |
| 512 | long mins = tsecs / 60; |
584 | long mins = tsecs / 60; |
| 513 | long secs = tsecs % 60; |
585 | long secs = tsecs % 60; |
| 514 | string pad = ""; |
586 | string pad = ""; |
| 515 | if (secs < 10) { |
587 | if (secs < 10) { |
| 516 | pad = "0"; |
588 | pad = "0"; |
| 517 | } |
589 | } |
| 518 | Console.WriteLine("Time spent: " + mins + ":" + pad + secs + ", " + Math.Round(bitRate, 2) + " bytes/s"); |
590 | Console.WriteLine("Time spent: " + mins + ":" + pad + secs + ", " + Math.Round(bitRate, 2) + " bytes/s"); |
| 519 | } |
591 | } |
| 520 | //Console.Write("> "); |
592 | //Console.Write("> "); |
| 521 | break; |
593 | break; |
| 522 | } |
594 | } |
| 523 | } |
595 | } |
| 524 | 596 | ||
| 525 | } catch(Exception) { |
597 | } catch(Exception) { |
| 526 | Console.WriteLine("Exception occured"); |
598 | Console.WriteLine("Exception occured"); |
| 527 | //Console.WriteLine(e); |
599 | //Console.WriteLine(e); |
| 528 | //skriva ut antal bytes skrivna vore bra här, kanske nån annan form av hjälp för debug, något gick snett liksom |
600 | //skriva ut antal bytes skrivna vore bra här, kanske nån annan form av hjälp för debug, något gick snett liksom |
| 529 | 601 | ||
| 530 | } |
602 | } |
| 531 | 603 | ||
| 532 | return !errorOccured; |
604 | return !errorOccured; |
| 533 | } |
605 | } |
| 534 | } |
606 | } |
| 535 | 607 | ||