📄 main.s
字号:
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
L216:
.dbline 584
L211:
.dbline 567
movw R24,R12
adiw R24,1
movw R12,R24
L213:
.dbline 567
cp R12,R10
cpc R13,R11
brsh X18
rjmp L210
X18:
.dbline 586
; }
;
; num_bytes = block_size+3;
movw R24,R10
adiw R24,3
std y+11,R25
std y+10,R24
.dbline 587
; msg_buffer[0] = CMD_READ_FLASH_ISP;
ldi R24,20
sts _msg_buffer,R24
.dbline 588
; msg_buffer[1] = STATUS_CMD_OK;
clr R2
sts _msg_buffer+1,R2
.dbline 589
; msg_buffer[block_size+2] = STATUS_CMD_OK;
ldi R24,<_msg_buffer
ldi R25,>_msg_buffer
movw R30,R10
adiw R30,2
add R30,R24
adc R31,R25
std z+0,R2
.dbline 590
; }
rjmp L206
L205:
.dbline 594
; //////////////////////////////////////
; //CMD_PROGRAM_EEPROM_ISP
; //////////////////////////////////////
; else if(cmd==CMD_PROGRAM_EEPROM_ISP)
ldd R24,y+12
cpi R24,21
breq X19
rjmp L219
X19:
.dbline 595
; {
.dbline 596
; block_size = ((unsigned int)msg_buffer[1])<<8;
lds R10,_msg_buffer+1
clr R11
mov R11,R10
clr R10
.dbline 597
; block_size |= msg_buffer[2];
lds R2,_msg_buffer+2
clr R3
or R10,R2
or R11,R3
.dbline 598
; mode = msg_buffer[3];
lds R14,_msg_buffer+3
.dbline 601
;
; //Byte Mode
; if((mode&1) == 0)
sbrc R14,0
rjmp L224
.dbline 602
; {
.dbline 603
; for(i=0;i<block_size;i++)
clr R12
clr R13
rjmp L229
L226:
.dbline 604
; {
.dbline 605
; spi_transfer_8(msg_buffer[5]);
lds R16,_msg_buffer+5
rcall _spi_transfer_8
.dbline 606
; 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 607
; 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 610
;
; //Check if we can do polling
; if((msg_buffer[i+10]!=msg_buffer[8])&&(msg_buffer[i+10]!=msg_buffer[9]))
ldi R24,<_msg_buffer
ldi R25,>_msg_buffer
movw R30,R12
adiw R30,10
add R30,R24
adc R31,R25
ldd R2,z+0
clr R3
lds R4,_msg_buffer+8
cp R2,R4
breq L231
lds R4,_msg_buffer+9
cp R2,R4
breq L231
.dbline 611
; {
.dbline 612
; polling_address = 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 R30,R28
std z+2,R2
std z+3,R3
std z+4,R4
std z+5,R5
.dbline 613
; }
rjmp L232
L231:
.dbline 616
; //If not switch the mode hard waiting
; else
; {
.dbline 617
; mode = (mode&(~0x0E)) | 0x02;
mov R24,R14
andi R24,241
ori R24,2
mov R14,R24
.dbline 618
; }
L232:
.dbline 622
;
; //Different polling methods
; //Hard waiting
; if((mode&0x0E) == 0x02)
mov R24,R14
andi R24,14
cpi R24,2
brne L235
.dbline 623
; {
.dbline 624
; wait_ms(msg_buffer[4]);
lds R16,_msg_buffer+4
clr R17
rcall _wait_ms
.dbline 625
; }
rjmp L236
L235:
.dbline 627
; //Data polling
; else if((mode&0x0E) == 0x04)
mov R24,R14
andi R24,14
cpi R24,4
brne L238
.dbline 628
; {
L240:
.dbline 629
; do{
.dbline 630
; spi_transfer_8(msg_buffer[7]);
lds R16,_msg_buffer+7
rcall _spi_transfer_8
.dbline 631
; spi_transfer_16(polling_address);
movw R30,R28
ldd R16,z+2
ldd R17,z+3
rcall _spi_transfer_16
.dbline 632
; tmp=spi_transfer_8(0x00);
clr R16
rcall _spi_transfer_8
std y+13,R16
.dbline 633
L241:
.dbline 633
; }while((tmp==msg_buffer[8])||(tmp==msg_buffer[9]));
lds R2,_msg_buffer+8
ldd R0,y+13
cp R0,R2
breq L240
lds R2,_msg_buffer+9
cp R0,R2
breq L240
.dbline 634
; }
rjmp L239
L238:
.dbline 636
; //RDY/BSY polling
; else if((mode&0x0E) == 0x08)
mov R24,R14
andi R24,14
cpi R24,8
brne L246
.dbline 637
; {
L248:
.dbline 638
L249:
.dbline 638
; 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 L248
.dbline 639
; }
rjmp L247
L246:
.dbline 643
; //If something was not correct with the given mode do
; //hard waiting. Should never reach this point
; else
; {
.dbline 644
; wait_ms(msg_buffer[4]);
lds R16,_msg_buffer+4
clr R17
rcall _wait_ms
.dbline 645
; }
L247:
L239:
L236:
.dbline 648
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
.dbline 649
L227:
.dbline 603
movw R24,R12
adiw R24,1
movw R12,R24
L229:
.dbline 603
cp R12,R10
cpc R13,R11
brsh X20
rjmp L226
X20:
.dbline 650
;
; //increment address
; address++;
; }
; }
rjmp L225
L224:
.dbline 653
; //Page Mode
; else
; {
.dbline 654
; for(i=0;i<block_size;i++)
clr R12
clr R13
rjmp L255
L252:
.dbline 655
; {
.dbline 656
; spi_transfer_8(msg_buffer[5]);
lds R16,_msg_buffer+5
rcall _spi_transfer_8
.dbline 657
; 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 658
; 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 661
;
; //Check if we can do polling
; if((msg_buffer[i+10]!=msg_buffer[8])&&(msg_buffer[i+10]!=msg_buffer[9]))
ldi R24,<_msg_buffer
ldi R25,>_msg_buffer
movw R30,R12
adiw R30,10
add R30,R24
adc R31,R25
ldd R2,z+0
clr R3
lds R4,_msg_buffer+8
cp R2,R4
breq L257
lds R4,_msg_buffer+9
cp R2,R4
breq L257
.dbline 662
; {
.dbline 663
; polling_address = 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 R30,R28
std z+2,R2
std z+3,R3
std z+4,R4
std z+5,R5
.dbline 664
; }
L257:
.dbline 667
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
.dbline 668
L253:
.dbline 654
movw R24,R12
adiw R24,1
movw R12,R24
L255:
.dbline 654
cp R12,R10
cpc R13,R11
brsh X21
rjmp L252
X21:
.dbline 671
;
; //increment (word) address only when we have an uneven (byte) address
; address++;
; }
;
; //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 L261
.dbline 672
; {
.dbline 673
; spi_transfer_8(msg_buffer[6]);
lds R16,_msg_buffer+6
rcall _spi_transfer_8
.dbline 674
; 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 675
; spi_transfer_8(0);
clr R16
rcall _spi_transfer_8
.dbline 678
;
; //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 L264
.dbline 679
; {
.dbline 680
; mode = (mode&(~0x70)) | 0x10;
mov R24,R14
andi R24,143
ori R24,16
mov R14,R24
.dbline 681
; }
L264:
.dbline 685
;
; //Different polling methods
; //Hard waiting
; if((mode&0x70) == 0x10)
mov R24,R14
andi R24,112
cpi R24,16
brne L266
.dbline 686
; {
.dbline 687
; wait_ms(msg_buffer[4]);
lds R16,_msg_buffer+4
clr R17
rcall _wait_ms
.dbline 688
; }
rjmp L267
L266:
.dbline 690
; //Data polling
; else if((mode&0x70) == 0x20)
mov R24,R14
andi R24,112
cpi R24,32
brne L269
.dbline 691
; {
L271:
.dbline 692
; do{
.dbline 695
; //If we have an uneven byte read the
; //high byte
; if(i&1)
sbrs R12,0
rjmp L274
.dbline 696
; {
.dbline 697
; spi_transfer_8(msg_buffer[7]|(1<<3));
lds R16,_msg_buffer+7
ori R16,8
rcall _spi_transfer_8
.dbline 698
; }
rjmp L275
L274:
.dbline 700
; else
; {
.dbline 701
; spi_transfer_8(msg_buffer[7]);
lds R16,_msg_buffer+7
rcall _spi_transfer_8
.dbline 702
; }
L275:
.dbline 703
; spi_transfer_16(polling_address);
movw R30,R28
ldd R16,z+2
ldd R17,z+3
rcall _spi_transfer_16
.dbline 704
; tmp=spi_transfer_8(0x00);
clr R16
rcall _spi_transfer_8
std y+13,R16
.dbline 705
L272:
.dbline 705
; }while(tmp==msg_buffer[8]);
lds R2,_msg_buffer+8
ldd R0,y+13
cp R0,R2
breq L271
.dbline 706
; }
rjmp L270
L269:
.dbline 708
; //RDY/BSY polling
; else if((mode&0x70) == 0x40)
mov R24,R14
andi R24,112
cpi R24,64
brne L279
.dbline 709
; {
L281:
.dbline 710
L282:
.dbline 710
; 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 L281
.dbline 711
; }
rjmp L280
L279:
.dbline 715
; //If something was not correct with the given mode do
; //hard waiting. Should never reach this point
; else
; {
.dbline 716
; wait_ms(msg_buffer[4]);
lds R16,_msg_buffer+4
clr R17
rcall _wait_ms
.dbline 717
; }
L280:
L270:
L267:
.dbline 718
; }
L261:
.dbline 719
; }
L225:
.dbline 721
;
; num_bytes = 2;
ldi R24,2
ldi R25,0
std y+11,R25
std y+10,R24
.dbline 722
; msg_buffer[0] = CMD_PROGRAM_EEPROM_ISP;
ldi R24,21
sts _msg_buffer,R24
.dbline 723
; msg_buffer[1] = STATUS_CMD_OK;
clr R2
sts _msg_buffer+1,R2
.dbline 724
; }
rjmp L220
L219:
.dbline 729
;
; //////////////////////////////////////
; //CMD_READ_EEPROM_ISP
; //////////////////////////////////////
; else if(cmd==CMD_READ_EEPROM_ISP)
ldd R24,y+12
cpi R24,22
breq X22
rjmp L286
X22:
.dbline 730
; {
.dbline 731
; block_size = ((unsigned int)msg_buffer[1])<<8;
lds R10,_msg_buffer+1
clr R11
mov R11,R10
clr R10
.dbline 732
; block_size |= msg_buffer[2];
lds R2,_msg_buffer+2
clr R3
or R10,R2
or R11,R3
.dbline 733
; tmp = msg_buffer[3];
lds R2,_msg_buffer+3
std y+13,R2
.dbline 735
;
; for(i=0;i<block_size;i++)
clr R12
clr R13
rjmp L294
L291:
.dbline 736
.dbline 738
ldd R16,y+13
rcall _spi_transfer_8
.dbline 739
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 740
clr R16
rcall _spi_transfer_8
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -