From 8c6920e34393c3982d4333c13c6ebb26f545c842 Mon Sep 17 00:00:00 2001 From: Jens Arnold Date: Sat, 8 Mar 2008 23:50:55 +0000 Subject: Revert accidental tree commit. Sorry for that. git-svn-id: svn://svn.rockbox.org/rockbox/trunk@16574 a1c6a512-1295-4272-9138-f99709370657 --- firmware/drivers/ata.c | 63 ++-- firmware/drivers/ata_mmc.c | 2 +- firmware/export/config-player.h | 2 +- firmware/export/id3.h | 1 - firmware/id3.c | 3 - firmware/target/arm/iriver/h10/lcd-h10_5gb.c | 114 ++++--- firmware/target/arm/system-pp502x.c | 2 +- firmware/target/coldfire/memcpy-coldfire.S | 440 +-------------------------- 8 files changed, 110 insertions(+), 517 deletions(-) (limited to 'firmware') diff --git a/firmware/drivers/ata.c b/firmware/drivers/ata.c index db8bdf92a0..549a7bf920 100644 --- a/firmware/drivers/ata.c +++ b/firmware/drivers/ata.c @@ -89,7 +89,6 @@ static bool initialized = false; static long last_user_activity = -1; long last_disk_activity = -1; -static unsigned long total_sectors; static int multisectors; /* number of supported multisectors */ static unsigned short identify_info[SECTOR_SIZE/2]; @@ -285,11 +284,6 @@ int ata_read_sectors(IF_MV2(int drive,) mutex_lock(&ata_mtx); #endif - if (start + incount > total_sectors) { - ret = -1; - goto error; - } - last_disk_activity = current_tick; spinup_start = current_tick; @@ -299,14 +293,16 @@ int ata_read_sectors(IF_MV2(int drive,) spinup = true; if (poweroff) { if (ata_power_on()) { - ret = -2; - goto error; + mutex_unlock(&ata_mtx); + ata_led(false); + return -1; } } else { if (perform_soft_reset()) { - ret = -2; - goto error; + mutex_unlock(&ata_mtx); + ata_led(false); + return -1; } } } @@ -316,8 +312,9 @@ int ata_read_sectors(IF_MV2(int drive,) SET_REG(ATA_SELECT, ata_device); if (!wait_for_rdy()) { - ret = -3; - goto error; + mutex_unlock(&ata_mtx); + ata_led(false); + return -2; } retry: @@ -374,7 +371,7 @@ int ata_read_sectors(IF_MV2(int drive,) We choose alternative 2. */ perform_soft_reset(); - ret = -5; + ret = -4; goto retry; } @@ -406,7 +403,7 @@ int ata_read_sectors(IF_MV2(int drive,) */ if ( status & (STATUS_BSY | STATUS_ERR | STATUS_DF) ) { perform_soft_reset(); - ret = -6; + ret = -5; goto retry; } @@ -418,14 +415,13 @@ int ata_read_sectors(IF_MV2(int drive,) if(!ret && !wait_for_end_of_transfer()) { perform_soft_reset(); - ret = -4; + ret = -3; goto retry; } break; } - - error: ata_led(false); + #ifndef MAX_PHYS_SECTOR_SIZE mutex_unlock(&ata_mtx); #endif @@ -493,9 +489,6 @@ int ata_write_sectors(IF_MV2(int drive,) mutex_lock(&ata_mtx); #endif - if (start + count > total_sectors) - panicf("Writing past end of disk"); - last_disk_activity = current_tick; spinup_start = current_tick; @@ -505,14 +498,16 @@ int ata_write_sectors(IF_MV2(int drive,) spinup = true; if (poweroff) { if (ata_power_on()) { - ret = -1; - goto error; + mutex_unlock(&ata_mtx); + ata_led(false); + return -1; } } else { if (perform_soft_reset()) { - ret = -1; - goto error; + mutex_unlock(&ata_mtx); + ata_led(false); + return -1; } } } @@ -520,8 +515,9 @@ int ata_write_sectors(IF_MV2(int drive,) SET_REG(ATA_SELECT, ata_device); if (!wait_for_rdy()) { - ret = -2; - goto error; + mutex_unlock(&ata_mtx); + ata_led(false); + return -2; } #ifdef HAVE_LBA48 @@ -579,8 +575,8 @@ int ata_write_sectors(IF_MV2(int drive,) ret = -4; } - error: ata_led(false); + #ifndef MAX_PHYS_SECTOR_SIZE mutex_unlock(&ata_mtx); #endif @@ -1244,16 +1240,11 @@ int ata_init(void) phys_sector_mult * SECTOR_SIZE); #endif - total_sectors = identify_info[60] | (identify_info[60] << 16); - #ifdef HAVE_LBA48 - if (identify_info[83] & 0x0400 /* 48 bit address support */ - && total_sectors == 0x0FFFFFFF) /* and disk size >= 128 GiB */ - { /* (needs BigLBA addressing) */ - if (identify_info[102] || identify_info[103]) - panicf("Unsupported disk size, >= 2^32 sectors"); - - total_sectors = identify_info[100] | (identify_info[101] << 16); + if (identify_info[83] & 0x0400 /* 48 bit address support */ + && identify_info[60] == 0xFFFF /* and disk size >= 128 GiB */ + && identify_info[61] == 0x0FFF) /* (needs BigLBA addressing) */ + { lba48 = true; /* use BigLBA */ } #endif diff --git a/firmware/drivers/ata_mmc.c b/firmware/drivers/ata_mmc.c index e0a2b17500..fdd091248f 100644 --- a/firmware/drivers/ata_mmc.c +++ b/firmware/drivers/ata_mmc.c @@ -814,7 +814,7 @@ int ata_write_sectors(IF_MV2(int drive,) } if (c_end_addr > card->size) - panicf("Writing past end of card"); + panicf("Writing past end of card\n"); blocksize = card->blocksize; offset = c_addr & (blocksize - 1); diff --git a/firmware/export/config-player.h b/firmware/export/config-player.h index c69fe8cfcb..b9e3035951 100644 --- a/firmware/export/config-player.h +++ b/firmware/export/config-player.h @@ -46,7 +46,7 @@ /* Uncomment this if you want to enable ATA power-off control. * Attention, some players crash when ATA power-off is enabled! */ -#define HAVE_ATA_POWER_OFF +//#define HAVE_ATA_POWER_OFF /* Define this if you control ata power player style (with PB4, new player only) */ diff --git a/firmware/export/id3.h b/firmware/export/id3.h index 267f1b4afa..bb3b6a6fe5 100644 --- a/firmware/export/id3.h +++ b/firmware/export/id3.h @@ -49,7 +49,6 @@ enum AFMT_WAVPACK, /* WavPack */ AFMT_ALAC, /* Apple Lossless Audio Codec */ AFMT_AAC, /* Advanced Audio Coding (AAC) in M4A container */ - AFMT_MOD, /* MOD File Format */ AFMT_SHN, /* Shorten */ AFMT_SID, /* SID File Format */ AFMT_ADX, /* ADX File Format */ diff --git a/firmware/id3.c b/firmware/id3.c index 87b4ce9d31..f594528910 100644 --- a/firmware/id3.c +++ b/firmware/id3.c @@ -90,9 +90,6 @@ const struct afmt_entry audio_formats[AFMT_NUM_CODECS] = [AFMT_AAC] = AFMT_ENTRY("AAC", "aac", NULL, "mp4\0" ), /* Shorten */ - [AFMT_MOD] = - AFMT_ENTRY("MOD", "mod", NULL, "mod\0" ), - /* Shorten */ [AFMT_SHN] = AFMT_ENTRY("SHN", "shorten", NULL, "shn\0" ), /* SID File Format */ diff --git a/firmware/target/arm/iriver/h10/lcd-h10_5gb.c b/firmware/target/arm/iriver/h10/lcd-h10_5gb.c index 680d2c47a5..8972fd1e9c 100644 --- a/firmware/target/arm/iriver/h10/lcd-h10_5gb.c +++ b/firmware/target/arm/iriver/h10/lcd-h10_5gb.c @@ -108,7 +108,6 @@ void lcd_init_device(void) { CLCD_CLOCK_SRC |= 0xc0000000; /* Set LCD interface clock to PLL */ /* H10 LCD is initialised by the bootloader */ - lcd_write_reg(R_ENTRY_MODE, 0x1030); /* BGR =1, ID1 = 1, ID0 = 1 */ } /*** update functions ***/ @@ -290,51 +289,88 @@ void lcd_yuv_blit(unsigned char * const src[3], /* Update a fraction of the display. */ -void lcd_update_rect(int x, int y, int width, int height) +void lcd_update_rect(int x0, int y0, int width, int height) { - const fb_data *addr; - int bytes_to_write; - - if (x + width >= LCD_WIDTH) - width = LCD_WIDTH - x; - if (y + height >= LCD_HEIGHT) - height = LCD_HEIGHT - y; - - if ((width <= 0) || (height <= 0)) - return; /* Nothing left to do. 0 would hang the transfer. */ - - /* Ensure x and width are both even, so we can read - * 32-bit aligned data from the framebuffer */ - width = (width + (x & 1) + 1) & ~1; - x &= ~1; - - lcd_write_reg(R_VERT_RAM_ADDR_POS, (LCD_HEIGHT-1) << 8); - lcd_write_reg(R_HORIZ_RAM_ADDR_POS, ((x + width - 1) << 8) | x); - lcd_write_reg(R_RAM_ADDR_SET, (y << 8) | x); + int x1, y1; + int newx,newwidth; + unsigned long *addr; + /* Ensure x and width are both even - so we can read 32-bit aligned + data from lcd_framebuffer */ + newx=x0&~1; + newwidth=width&~1; + if (newx+newwidth < x0+width) { newwidth+=2; } + x0=newx; width=newwidth; + + /* calculate the drawing region */ + y1 = (y0 + height) - 1; /* max vert */ + x1 = (x0 + width) - 1; /* max horiz */ + + + /* swap max horiz < start horiz */ + if (y1 < y0) { + int t; + t = y0; + y0 = y1; + y1 = t; + } + + /* swap max vert < start vert */ + if (x1 < x0) { + int t; + t = x0; + x0 = x1; + x1 = t; + } + + /* max horiz << 8 | start horiz */ + lcd_write_reg(R_HORIZ_RAM_ADDR_POS, (x1 << 8) | x0); + + /* max vert << 8 | start vert */ + lcd_write_reg(R_VERT_RAM_ADDR_POS, (y1 << 8) | y0); + + /* start vert << 8 | start horiz */ + lcd_write_reg(R_RAM_ADDR_SET, (y0 << 8) | x0); + + /* start drawing */ lcd_send_cmd(R_WRITE_DATA_2_GRAM); - addr = &lcd_framebuffer[y][x]; - bytes_to_write = width * height * sizeof(fb_data); - /* must be <= 0x10000, but that's guaranteed on H10. */ + addr = (unsigned long*)&lcd_framebuffer[y0][x0]; - LCD2_BLOCK_CTRL = 0x10000080; - LCD2_BLOCK_CONFIG = 0xc0010000 | (bytes_to_write - 1); - LCD2_BLOCK_CTRL = 0x34000000; - - do - { - int w = width >> 1; - do - { - while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_TXOK)); - LCD2_BLOCK_DATA = *(unsigned long*)addr; /* output 2 pixels */ - addr += 2; + while (height > 0) { + int c, r; + int h, pixels_to_write; + + pixels_to_write = (width * height) * 2; + h = height; + + /* calculate how much we can do in one go */ + if (pixels_to_write > 0x10000) { + h = (0x10000/2) / width; + pixels_to_write = (width * h) * 2; } - while (--w > 0); - addr += LCD_WIDTH - width; + + LCD2_BLOCK_CTRL = 0x10000080; + LCD2_BLOCK_CONFIG = 0xc0010000 | (pixels_to_write - 1); + LCD2_BLOCK_CTRL = 0x34000000; + + /* for each row */ + for (r = 0; r < h; r++) { + /* for each column */ + for (c = 0; c < width; c += 2) { + while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_TXOK)); + + /* output 2 pixels */ + LCD2_BLOCK_DATA = *addr++; + } + addr += (LCD_WIDTH - width)/2; + } + + while (!(LCD2_BLOCK_CTRL & LCD2_BLOCK_READY)); + LCD2_BLOCK_CONFIG = 0; + + height -= h; } - while (--height > 0); } /* Update the display. diff --git a/firmware/target/arm/system-pp502x.c b/firmware/target/arm/system-pp502x.c index a5ed7b2999..27d11aa815 100644 --- a/firmware/target/arm/system-pp502x.c +++ b/firmware/target/arm/system-pp502x.c @@ -365,7 +365,7 @@ void system_init(void) #elif defined (IPOD_MINI) /* to be done */ #elif defined (IPOD_MINI2G) - /* to be done */ + /* to be done */ #elif defined (MROBE_100) /* to be done */ #elif defined (ELIO_TPJ1022) diff --git a/firmware/target/coldfire/memcpy-coldfire.S b/firmware/target/coldfire/memcpy-coldfire.S index dd1a8a66da..523e1f5ed9 100644 --- a/firmware/target/coldfire/memcpy-coldfire.S +++ b/firmware/target/coldfire/memcpy-coldfire.S @@ -38,8 +38,8 @@ * %d0 - destination address (like ANSI version) * * register usage: - * %a1 - current source address - * %a0 - current dest address + * %a0 - current source address + * %a1 - current dest address * %a2 - source end address (in line-copy loops) * %d0 - data / scratch * %d1 - source end address (byte and longword copy) / data / scratch @@ -52,439 +52,11 @@ * if FULLSPEED is undefined. */ memcpy: - move.l (4, %sp), %a1 /* Destination */ - move.l (8, %sp), %a0 /* Source */ - move.l (12, %sp), %d1 /* Length */ + move.l (4,%sp),%a1 /* Destination */ + move.l (8,%sp),%a0 /* Source */ + move.l (12,%sp),%d1 /* Length */ __memcpy_fwd_entry: - -#if 1 /* CODE TEST */ - - cmp.l #5, %d1 - bhs.b .min5 - - move.l %a1, %d0 - jmp.l (2, %pc, %d1.l*4) -.bytes_grid: - rts /* 0 */ - nop -.bytes_1: - move.b (%a0)+, (%a1)+ /* 1 */ - rts - move.w (%a0)+, (%a1)+ /* 2 */ - rts - move.w (%a0)+, (%a1)+ /* 3 */ - bra.s .bytes_1 - move.l (%a0)+, (%a1)+ /* 4 */ - rts - -.min5: - move.l %a0, %d0 - and.l #3, %d0 - jmp.l (2, %pc, %d0.l*2) - bra.s .byte1_off0 - bra.s .byte1_off1 - bra.s .byte1_off2 - /* last table entry coincides with target */ - -.byte1_off3: - move.b (%a0)+, (%a1)+ - subq.l #1, %d1 - bra.s .byte1_off0 - -.byte1_off1: - move.b (%a0)+, (%a1)+ - subq.l #1, %d1 -.byte1_off2: - move.w (%a0)+, (%a1)+ - subq.l #2, %d1 -.byte1_off0: - - move.l %d1, %d0 - cmp.l #16, %d0 - bhs.b .min16 - -.longs: - lsr.l #2, %d0 /* in longwords */ - neg.l %d0 - jmp.l (8, %pc, %d0.l*2) - - move.l (%a0)+, (%a1)+ - move.l (%a0)+, (%a1)+ - move.l (%a0)+, (%a1)+ - move.l (4, %sp), %d0 - and.l #3, %d1 - jmp.l (.bytes_grid - 2 - ., %pc, %d1.l*4) - -.min16: -#if 0 - lea.l (-44, %sp), %sp - movem.l %d2-%d7/%a2-%a6, (%sp) - - -.main_do12_start: - lea.l (main_do12_loop - ., %pc), %a5 - movem.l (%a0), %d6-%d7/%a2-%a3 - bra.b .main_do12_headstore - -.main_do8_start: - lea.l (main_do8_loop - ., %pc), %a5 - movem.l (%a0), %d5-%d7/%a2 - bra.b .main_do8_headstore - -.main_do4_start: - lea.l (main_do4_loop - ., %pc), %a5 - movem.l (%a0), %d4-%d7 -/* .main_do4_headstore: */ - move.l %d4, (%a1)+ -.main_do8_headstore: - move.l %d5, (%a1)+ -.main_do12_headstore: - move.l %d6, (%a1)+ - bra.b .main_bo0_check - -.main_do12_loop: - move.l %d7, %d3 - move.l %a2, %d4 - move.l %a3, %d5 - movem.l (%a0), %d6-%d7/%a2-%a3 - bra.b .main_bo0_store -.main_do8_loop: - move.l %d7, %d3 - move.l %a2, %d4 - movem.l (%a0), %d5-%d7/%a2 - bra.b .main_bo0_store -.main_do4_loop: - move.l %d7, %d3 - movem.l (%a0), %d4-%d7 - bra.b .main_bo0_store -.main_do0_loop: - movem.l (%a0), %d3-%d6 -.main_bo0_store: - lea.l (16, %a0), %a1 - movem.l %d3-%d6, (%a1) - lea.l (16, %a1), %a1 -.main_do0_start: -.main_bo0_check: - sub.l #16, %d1 - blo.b .main_bo0_tail - jmp (%a5) - -.main_bo0_tail: - - - -.main_do13_start: - lea.l (main_do13_loop - ., %pc), %a5 - movem.l (%a0), %d7/%a2-%a4 - move.l %d7, %d0 - lsr.l #8, %d0 - swap %d0 - move.b %d0, (%a1)+ - swap %d0 - move.w %d0, (%a1)+ - bra.b .main_bo1_check - -.main_do9_start: - lea.l (main_do9_loop - ., %pc), %a5 - movem.l (%a0), %d6-%d7/%a2-%a3 - move.l %d6, %d0 - lsr.l #8, %d0 - swap %d0 - move.b %d0, (%a1)+ - swap %d0 - move.w %d0, (%a1)+ - bra.b .main_do9_headstore - -.main_do5_start: - lea.l (main_do5_loop - ., %pc), %a5 - movem.l (%a0), %d5-%d7/%a2 - move.l %d5, %d0 - lsr.l #8, %d0 - swap %d0 - move.b %d0, (%a1)+ - swap %d0 - move.w %d0, (%a1)+ - bra.b .main_do5_headstore - -.main_do1_start: - lea.l (main_do1_loop - ., %pc), %a5 - movem.l (%a0), %d4-%d7 - move.l %d4, %d0 - lsr.l #8, %d0 - swap %d0 - move.b %d0, (%a1)+ - swap %d0 - move.w %d0, (%a1)+ -/* .main_do1_headstore: */ - lsl.l %d2, %d4 - move.l %d5, %d0 - lsr.l #8, %d0 - or.l %d0, %d4 - move.l %d4, (%a1)+ -.main_do5_headstore: - lsl.l %d2, %d5 - move.l %d6, %d0 - lsr.l #8, %d0 - or.l %d0, %d5 - move.l %d5, (%a1)+ -.main_do9_headstore: - lsl.l %d2, %d6 - move.l %d7, %d0 - lsr.l #8, %d0 - or.l %d0, %d6 - move.l %d6, (%a1)+ - bra.b .main_bo1_check - -.main_do13_loop: - move.l %d7, %d3 - move.l %a2, %d4 - move.l %a3, %d5 - move.l %a4, %d6 - movem.l (%a0), %d7/%a2-%a4 - bra.b .main_bo1_store -.main_do9_loop: - move.l %d7, %d3 - move.l %a2, %d4 - move.l %a3, %d5 - movem.l (%a0), %d6-%d7/%a2-%a3 - bra.b .main_bo1_store -.main_do5_loop: - move.l %d7, %d3 - move.l %a2, %d4 - movem.l (%a0), %d5-%d7/%a2 - bra.b .main_bo1_store -.main_do1_loop: - move.l %d7, %d3 - movem.l (%a0), %d4-%d7 -.main_bo1_store: - lea.l (16, %a0), %a1 - lsl.l %d2, %d3 - move.l %d4, %d0 - lsr.l #8, %d0 - or.l %d0, %d3 - lsl.l %d2, %d4 - move.l %d5, %d0 - lsr.l #8, %d0 - or.l %d0, %d4 - lsl.l %d2, %d5 - move.l %d6, %d0 - lsr.l #8, %d0 - or.l %d0, %d5 - lsl.l %d2, %d6 - move.l %d7, %d0 - lsr.l #8, %d0 - or.l %d0, %d6 - movem.l %d3-%d6,(%a1) - lea.l (16, %a1), %a1 -.main_bo1_check: - sub.l #16, %d1 - blo.b .main_bo1_tail - jmp (%a5) - - -.main_do14_start: - lea.l (main_do14_loop - ., %pc), %a5 - movem.l (%a0), %d7/%a2-%a4 - swap %d7 - move.w %d7, (%a1)+ - bra.b .main_bo2_check - -.main_do10_start: - lea.l (main_do10_loop - ., %pc), %a5 - movem.l (%a0), %d6-%d7/%a2-%a3 - swap %d6 - move.w %d6, (%a1)+ - bra.b .main_do10_headstore - -.main_do6_start: - lea.l (main_do6_loop - ., %pc), %a5 - movem.l (%a0), %d5-%d7/%a2 - swap %d5 - move.w %d5, (%a1)+ - bra.b .main_do6_headstore - -.main_do2_start: - lea.l (main_do2_loop - ., %pc), %a5 - movem.l (%a0), %d4-%d7 - swap %d4 - move.w %d4, (%a1)+ -/* .main_do2_headstore: */ - swap %d5 - move.w %d5, %d4 - move.l %d4, (%a1)+ -.main_do6_headstore: - swap %d6 - move.w %d6, %d5 - move.l %d5, (%a1)+ -.main_do10_headstore: - swap %d7 - move.w %d7, %d6 - move.l %d6, (%a1)+ - bra.b .main_bo2_check - -.main_do14_loop: - move.l %d7, %d3 - move.l %a2, %d4 - move.l %a3, %d5 - move.l %a4, %d6 - movem.l (%a0), %d7/%a2-%a4 - bra.b .main_bo1_store -.main_do10_loop: - move.l %d7, %d3 - move.l %a2, %d4 - move.l %a3, %d5 - movem.l (%a0), %d6-%d7/%a2-%a3 - bra.b .main_bo1_store -.main_do6_loop: - move.l %d7, %d3 - move.l %a2, %d4 - movem.l (%a0), %d5-%d7/%a2 - bra.b .main_bo1_store -.main_do2_loop: - move.l %d7, %d3 - movem.l (%a0), %d4-%d7 -.main_bo2_store: - lea.l (16, %a0), %a1 - swap %d4 - move.w %d4,%d3 - swap %d5 - move.w %d5,%d4 - swap %d6 - move.w %d6,%d5 - swap %d7 - move.w %d7,%d6 - movem.l %d3-%d6,(%a1) - lea.l (16, %a1), %a1 -.main_bo2_check - sub.l #16, %d1 - blo.b .main_bo2_tail - jmp (%a5) - - -.main_do15_start: - lea.l (main_do15_loop - ., %pc), %a5 - movem.l (%a0), %d7/%a2-%a4 - move.l %d7, %d0 - lsr.l %d2, %d0 - move.b %d0, (%a1)+ - bra.b .main_bo3_check - -.main_do11_start: - lea.l (main_do11_loop - ., %pc), %a5 - movem.l (%a0), %d6-%d7/%a2-%a3 - move.l %d6, %d0 - lsr.l %d2, %d0 - move.b %d0, (%a1)+ - bra.b .main_do11_headstore - -.main_do7_start: - lea.l (main_do7_loop - ., %pc), %a5 - movem.l (%a0), %d5-%d7/%a2 - move.l %d5, %d0 - lsr.l %d2, %d0 - move.b %d0, (%a1)+ - bra.b .main_do7_headstore - -.main_do3_start: - lea.l (main_do3_loop - ., %pc), %a5 - movem.l (%a0), %d4-%d7 - move.l %d4, %d0 - lsr.l %d2, %d0 - move.b %d0, (%a1)+ -/* .main_do3_headstore: */ - lsl.l #8, %d4 - move.l %d5, %d0 - lsr.l %d2, %d0 - or.l %d0, %d4 - move.l %d4, (%a1)+ -.main_do7_headstore: - lsl.l #8, %d5 - move.l %d6, %d0 - lsr.l %d2, %d0 - or.l %d0, %d5 - move.l %d5, (%a1)+ -.main_do11_headstore: - lsl.l #8, %d6 - move.l %d7, %d0 - lsr.l %d2, %d0 - or.l %d0, %d6 - move.l %d6, (%a1)+ - bra.b .main_bo3_check - -.main_do15_loop: - move.l %d7, %d3 - move.l %a2, %d4 - move.l %a3, %d5 - move.l %a4, %d6 - movem.l (%a0), %d7/%a2-%a4 - bra.b .main_bo1_store -.main_do11_loop: - move.l %d7, %d3 - move.l %a2, %d4 - move.l %a3, %d5 - movem.l (%a0), %d6-%d7/%a2-%a3 - bra.b .main_bo1_store -.main_do7_loop: - move.l %d7, %d3 - move.l %a2, %d4 - movem.l (%a0), %d5-%d7/%a2 - bra.b .main_bo1_store -.main_do3_loop: - move.l %d7, %d3 - movem.l (%a0), %d4-%d7 -.main_bo3_store: - lea.l (16, %a0), %a1 - lsl.l #8, %d3 - move.l %d4, %d0 - lsr.l %d2, %d0 - or.l %d0, %d3 - lsl.l #8, %d4 - move.l %d5, %d0 - lsr.l %d2, %d0 - or.l %d0, %d4 - lsl.l #8, %d5 - move.l %d6, %d0 - lsr.l %d2, %d0 - or.l %d0, %d5 - lsl.l #8, %d6 - move.l %d7, %d0 - lsr.l %d2, %d0 - or.l %d0, %d6 - movem.l %d3-%d6,(%a1) - lea.l (16, %a1), %a1 -.main_bo3_check: - sub.l #16, %d1 - blo.b .main_bo3_tail - jmp (%a5) - - - - movem.l (%sp), %d2-%d7/%a2-%a6 - lea.l (44, %sp), %sp -#else - lea.l (-16, %sp), %sp - movem.l %d2-%d5, (%sp) - sub.l #16, %d1 - -.main_loop: - movem.l (%a0), %d2-%d5 - lea.l (16, %a0), %a0 - movem.l %d2-%d5, (%a1) - lea.l (16, %a1), %a1 - sub.l #16, %d1 - bhs.b .main_loop - - add.l #16, %d1 - movem.l (%sp), %d2-%d5 - lea.l (16, %sp), %sp -#endif - - move.l %d1, %d0 - bra.s .longs - -#else /* CODE TEST */ - add.l %a0,%d1 /* %d1 = source end */ move.l %a0,%d0 @@ -1103,8 +675,6 @@ __memcpy_fwd_entry: .bytes2_end: move.l (4,%sp),%d0 /* return destination */ rts - -#endif /* CODE TEST */ .end: .size memcpy,.end-memcpy -- cgit v1.2.3