📄 main.s
字号:
and R5,R23
movw R30,R28
std z+2,R2
std z+3,R3
std z+4,R4
std z+5,R5
.dbline 423
; }
rjmp L142
L141:
.dbline 426
; //If not switch the mode hard waiting
; else
; {
.dbline 427
; mode = (mode&(~0x0E)) | 0x02;
mov R24,R14
andi R24,241
ori R24,2
mov R14,R24
.dbline 428
; }
L142:
.dbline 432
;
; //Different polling methods
; //Hard waiting
; if((mode&0x0E) == 0x02)
mov R24,R14
andi R24,14
cpi R24,2
brne L144
.dbline 433
; {
.dbline 434
; wait_ms(msg_buffer[4]);
lds R16,_msg_buffer+4
clr R17
rcall _wait_ms
.dbline 435
; }
rjmp L145
L144:
.dbline 437
; //Data polling
; else if((mode&0x0E) == 0x04)
mov R24,R14
andi R24,14
cpi R24,4
brne L147
.dbline 438
; {
L149:
.dbline 439
; do{
.dbline 442
; //If we have an uneven byte read the
; //high byte
; if(i&1)
sbrs R12,0
rjmp L152
.dbline 443
; {
.dbline 444
; spi_transfer_8(msg_buffer[7]|(1<<3));
lds R16,_msg_buffer+7
ori R16,8
rcall _spi_transfer_8
.dbline 445
; }
rjmp L153
L152:
.dbline 447
; else
; {
.dbline 448
; spi_transfer_8(msg_buffer[7]);
lds R16,_msg_buffer+7
rcall _spi_transfer_8
.dbline 449
; }
L153:
.dbline 450
; spi_transfer_16(polling_address);
movw R30,R28
ldd R16,z+2
ldd R17,z+3
rcall _spi_transfer_16
.dbline 451
; tmp=spi_transfer_8(0x00);
clr R16
rcall _spi_transfer_8
std y+13,R16
.dbline 452
L150:
.dbline 452
; }while(tmp==msg_buffer[8]);
lds R2,_msg_buffer+8
ldd R0,y+13
cp R0,R2
breq L149
.dbline 453
; }
rjmp L148
L147:
.dbline 455
; //RDY/BSY polling
; else if((mode&0x0E) == 0x08)
mov R24,R14
andi R24,14
cpi R24,8
brne L157
.dbline 456
; {
L159:
.dbline 457
L160:
.dbline 457
; while(spi_transfer_32(0xF0000000)&1);
ldi R16,0
ldi R17,0
ldi R18,0
ldi R19,240
rcall _spi_transfer_32
sbrc R16,0
rjmp L159
.dbline 458
; }
rjmp L158
L157:
.dbline 462
; //If something was not correct with the given mode do
; //hard waiting. Should never reach this point
; else
; {
.dbline 463
; wait_ms(msg_buffer[4]);
lds R16,_msg_buffer+4
clr R17
rcall _wait_ms
.dbline 464
; }
L158:
L148:
L145:
.dbline 467
;
; //increment (word) address only when we have an uneven (byte) address
; if(i&1) address++;
sbrs R12,0
rjmp L163
.dbline 467
ldi R20,1
ldi R21,0
ldi R22,0
ldi R23,0
lds R4,_address+2
lds R5,_address+2+1
lds R2,_address
lds R3,_address+1
add R2,R20
adc R3,R21
adc R4,R22
adc R5,R23
sts _address+1,R3
sts _address,R2
sts _address+2+1,R5
sts _address+2,R4
L163:
.dbline 468
L134:
.dbline 403
movw R24,R12
adiw R24,1
movw R12,R24
L136:
.dbline 403
cp R12,R10
cpc R13,R11
brsh X12
rjmp L133
X12:
.dbline 469
; }
; }
rjmp L132
L131:
.dbline 472
; //Page Mode
; else
; {
.dbline 473
; for(i=0;i<block_size;i++)
clr R12
clr R13
rjmp L168
L165:
.dbline 474
; {
.dbline 477
; //If we have an uneven byte programm the
; //high byte
; if(i&1)
sbrs R12,0
rjmp L169
.dbline 478
; {
.dbline 479
; spi_transfer_8(msg_buffer[5]|(1<<3));
lds R16,_msg_buffer+5
ori R16,8
rcall _spi_transfer_8
.dbline 480
; }
rjmp L170
L169:
.dbline 482
; else
; {
.dbline 483
; spi_transfer_8(msg_buffer[5]);
lds R16,_msg_buffer+5
rcall _spi_transfer_8
.dbline 484
; }
L170:
.dbline 486
;
; spi_transfer_16(address&0xFFFF);
ldi R20,255
ldi R21,255
ldi R22,0
ldi R23,0
lds R4,_address+2
lds R5,_address+2+1
lds R2,_address
lds R3,_address+1
and R2,R20
and R3,R21
and R4,R22
and R5,R23
movw R16,R2
rcall _spi_transfer_16
.dbline 487
; spi_transfer_8(msg_buffer[i+10]);
ldi R24,<_msg_buffer
ldi R25,>_msg_buffer
movw R30,R12
adiw R30,10
add R30,R24
adc R31,R25
ldd R16,z+0
rcall _spi_transfer_8
.dbline 490
;
; //Check if we can do polling
; if(msg_buffer[8]!=msg_buffer[i+10])
ldi R24,<_msg_buffer
ldi R25,>_msg_buffer
movw R30,R12
adiw R30,10
add R30,R24
adc R31,R25
ldd R2,z+0
lds R3,_msg_buffer+8
cp R3,R2
brne X13
rjmp L173
X13:
.dbline 491
; {
.dbline 495
; //We have to check if we have an uneven byte.
; //Set the polling address to a byte address
; //so that we can poll the right location
; polling_address = (address&0xFFFF)*2;
ldi R20,255
ldi R21,255
ldi R22,0
ldi R23,0
lds R4,_address+2
lds R5,_address+2+1
lds R2,_address
lds R3,_address+1
and R2,R20
and R3,R21
and R4,R22
and R5,R23
ldi R20,2
ldi R21,0
ldi R22,0
ldi R23,0
st -y,R5
st -y,R4
st -y,R3
st -y,R2
movw R16,R20
movw R18,R22
rcall empy32u
movw R30,R28
std z+2,R16
std z+3,R17
std z+4,R18
std z+5,R19
.dbline 496
; if(i&1) polling_address++;
sbrs R12,0
rjmp L176
.dbline 496
ldi R20,1
ldi R21,0
ldi R22,0
ldi R23,0
movw R30,R28
ldd R2,z+2
ldd R3,z+3
ldd R4,z+4
ldd R5,z+5
add R2,R20
adc R3,R21
adc R4,R22
adc R5,R23
movw R30,R28
std z+2,R2
std z+3,R3
std z+4,R4
std z+5,R5
L176:
.dbline 497
; }
L173:
.dbline 500
;
; //increment (word) address only when we have an uneven (byte) address
; if(i&1) address++;
sbrs R12,0
rjmp L178
.dbline 500
ldi R20,1
ldi R21,0
ldi R22,0
ldi R23,0
lds R4,_address+2
lds R5,_address+2+1
lds R2,_address
lds R3,_address+1
add R2,R20
adc R3,R21
adc R4,R22
adc R5,R23
sts _address+1,R3
sts _address,R2
sts _address+2+1,R5
sts _address+2,R4
L178:
.dbline 501
L166:
.dbline 473
movw R24,R12
adiw R24,1
movw R12,R24
L168:
.dbline 473
cp R12,R10
cpc R13,R11
brsh X14
rjmp L165
X14:
.dbline 504
; }
;
; //If this page is complete the bit 7 of mode will be set and we programm the page
; if(mode&0x80)
sbrs R14,7
rjmp L180
.dbline 505
; {
.dbline 506
; spi_transfer_8(msg_buffer[6]);
lds R16,_msg_buffer+6
rcall _spi_transfer_8
.dbline 507
; spi_transfer_16(start_address&0xFFFF);
ldi R20,255
ldi R21,255
ldi R22,0
ldi R23,0
movw R30,R28
ldd R2,z+6
ldd R3,z+7
ldd R4,z+8
ldd R5,z+9
and R2,R20
and R3,R21
and R4,R22
and R5,R23
movw R16,R2
rcall _spi_transfer_16
.dbline 508
; spi_transfer_8(0);
clr R16
rcall _spi_transfer_8
.dbline 511
;
; //If we have no valid polling address switch to simple wait mode
; if(polling_address==0)
ldi R20,0
ldi R21,0
ldi R22,0
ldi R23,0
movw R30,R28
ldd R2,z+2
ldd R3,z+3
ldd R4,z+4
ldd R5,z+5
cp R2,R20
cpc R3,R21
cpc R4,R22
cpc R5,R23
brne L183
.dbline 512
; {
.dbline 513
; mode = (mode&(~0x70)) | 0x10;
mov R24,R14
andi R24,143
ori R24,16
mov R14,R24
.dbline 514
; }
L183:
.dbline 518
;
; //Different polling methods
; //Hard waiting
; if((mode&0x70) == 0x10)
mov R24,R14
andi R24,112
cpi R24,16
brne L185
.dbline 519
; {
.dbline 520
; wait_ms(msg_buffer[4]);
lds R16,_msg_buffer+4
clr R17
rcall _wait_ms
.dbline 521
; }
rjmp L186
L185:
.dbline 523
; //Data polling
; else if((mode&0x70) == 0x20)
mov R24,R14
andi R24,112
cpi R24,32
breq X15
rjmp L188
X15:
.dbline 524
; {
L190:
.dbline 525
; do{
.dbline 528
; //If we have an uneven byte read the
; //high byte
; if(polling_address%2)
ldi R20,1
ldi R21,0
ldi R22,0
ldi R23,0
movw R30,R28
ldd R2,z+2
ldd R3,z+3
ldd R4,z+4
ldd R5,z+5
and R2,R20
and R3,R21
and R4,R22
and R5,R23
ldi R20,0
ldi R21,0
ldi R22,0
ldi R23,0
cp R2,R20
cpc R3,R21
cpc R4,R22
cpc R5,R23
breq L193
.dbline 529
; {
.dbline 530
; spi_transfer_8(msg_buffer[7]|(1<<3));
lds R16,_msg_buffer+7
ori R16,8
rcall _spi_transfer_8
.dbline 531
; }
rjmp L194
L193:
.dbline 533
; else
; {
.dbline 534
; spi_transfer_8(msg_buffer[7]);
lds R16,_msg_buffer+7
rcall _spi_transfer_8
.dbline 535
; }
L194:
.dbline 536
; spi_transfer_16(polling_address/2);
movw R30,R28
ldd R2,z+2
ldd R3,z+3
ldd R4,z+4
ldd R5,z+5
lsr R5
ror R4
ror R3
ror R2
movw R16,R2
rcall _spi_transfer_16
.dbline 537
; tmp=spi_transfer_8(0x00);
clr R16
rcall _spi_transfer_8
std y+13,R16
.dbline 538
L191:
.dbline 538
; }while(tmp==msg_buffer[8]);
lds R2,_msg_buffer+8
ldd R0,y+13
cp R0,R2
brne X16
rjmp L190
X16:
.dbline 539
; }
rjmp L189
L188:
.dbline 541
; //RDY/BSY polling
; else if((mode&0x70) == 0x40)
mov R24,R14
andi R24,112
cpi R24,64
brne L198
.dbline 542
; {
L200:
.dbline 543
L201:
.dbline 543
; while(spi_transfer_32(0xF0000000)&1);
ldi R16,0
ldi R17,0
ldi R18,0
ldi R19,240
rcall _spi_transfer_32
sbrc R16,0
rjmp L200
.dbline 544
; }
rjmp L199
L198:
.dbline 548
; //If something was not correct with the given mode do
; //hard waiting. Should never reach this point
; else
; {
.dbline 549
; wait_ms(msg_buffer[4]);
lds R16,_msg_buffer+4
clr R17
rcall _wait_ms
.dbline 550
; }
L199:
L189:
L186:
.dbline 551
; }
L180:
.dbline 552
; }
L132:
.dbline 554
;
; num_bytes = 2;
ldi R24,2
ldi R25,0
std y+11,R25
std y+10,R24
.dbline 555
; msg_buffer[0] = CMD_PROGRAM_FLASH_ISP;
ldi R24,19
sts _msg_buffer,R24
.dbline 556
; msg_buffer[1] = STATUS_CMD_OK;
clr R2
sts _msg_buffer+1,R2
.dbline 557
; }
rjmp L127
L126:
.dbline 561
; //////////////////////////////////////
; //CMD_READ_FLASH_ISP
; //////////////////////////////////////
; else if(cmd==CMD_READ_FLASH_ISP)
ldd R24,y+12
cpi R24,20
breq X17
rjmp L205
X17:
.dbline 562
; {
.dbline 563
; block_size = ((unsigned int)msg_buffer[1])<<8;
lds R10,_msg_buffer+1
clr R11
mov R11,R10
clr R10
.dbline 564
; block_size |= msg_buffer[2];
lds R2,_msg_buffer+2
clr R3
or R10,R2
or R11,R3
.dbline 565
; tmp = msg_buffer[3];
lds R2,_msg_buffer+3
std y+13,R2
.dbline 567
;
; for(i=0;i<block_size;i++)
clr R12
clr R13
rjmp L213
L210:
.dbline 568
; {
.dbline 570
; //Select Low or High-Byte
; if(i&1)
sbrs R12,0
rjmp L214
.dbline 571
; {
.dbline 572
; spi_transfer_8(tmp|(1<<3));
ldd R16,y+13
ori R16,8
rcall _spi_transfer_8
.dbline 573
; }
rjmp L215
L214:
.dbline 575
; else
; {
.dbline 576
; spi_transfer_8(tmp);
ldd R16,y+13
rcall _spi_transfer_8
.dbline 577
; }
L215:
.dbline 579
;
; spi_transfer_16(address&0xFFFF);
ldi R20,255
ldi R21,255
ldi R22,0
ldi R23,0
lds R4,_address+2
lds R5,_address+2+1
lds R2,_address
lds R3,_address+1
and R2,R20
and R3,R21
and R4,R22
and R5,R23
movw R16,R2
rcall _spi_transfer_16
.dbline 580
; msg_buffer[i+2] = spi_transfer_8(0);
clr R16
rcall _spi_transfer_8
ldi R24,<_msg_buffer
ldi R25,>_msg_buffer
movw R30,R12
adiw R30,2
add R30,R24
adc R31,R25
std z+0,R16
.dbline 583
;
; //increment (word) address only when we have an uneven (byte) address
; if(i&1) address++;
sbrs R12,0
rjmp L216
.dbline 583
ldi R20,1
ldi R21,0
ldi R22,0
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -