From 31ffd7b1540c42e9cc051dc73a1f3acf77885e5d Mon Sep 17 00:00:00 2001 From: Jens Arnold Date: Sun, 3 Dec 2006 22:13:44 +0000 Subject: Completed target tree move of the ata driver code. Some code cleanup. git-svn-id: svn://svn.rockbox.org/rockbox/trunk@11655 a1c6a512-1295-4272-9138-f99709370657 --- firmware/target/sh/archos/ata-archos.c | 76 ++++++++++ firmware/target/sh/archos/ata-as-archos.S | 231 ++++++++++++++++++++++++++++++ firmware/target/sh/archos/ata-target.h | 80 +++++++++++ 3 files changed, 387 insertions(+) create mode 100755 firmware/target/sh/archos/ata-archos.c create mode 100755 firmware/target/sh/archos/ata-as-archos.S create mode 100755 firmware/target/sh/archos/ata-target.h (limited to 'firmware/target/sh/archos') diff --git a/firmware/target/sh/archos/ata-archos.c b/firmware/target/sh/archos/ata-archos.c new file mode 100755 index 0000000000..73e56b8d84 --- /dev/null +++ b/firmware/target/sh/archos/ata-archos.c @@ -0,0 +1,76 @@ +/*************************************************************************** + * __________ __ ___. + * Open \______ \ ____ ____ | | _\_ |__ _______ ___ + * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / + * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < + * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ + * \/ \/ \/ \/ \/ + * $Id$ + * + * Copyright (C) 2006 by Jens Arnold + * + * All files in this archive are subject to the GNU General Public License. + * See the file COPYING in the source tree root for full license agreement. + * + * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY + * KIND, either express or implied. + * + ****************************************************************************/ + +#include "config.h" +#include "cpu.h" +#include +#include "kernel.h" +#include "system.h" +#include "ata-target.h" +#include "hwcompat.h" + +volatile unsigned char* ata_control; +int ata_io_address; /* 0x300 or 0x200 */ + +void ata_reset(void) +{ + /* state HRR0 */ + and_b(~0x02, &PADRH); /* assert _RESET */ + sleep(1); /* > 25us */ + + /* state HRR1 */ + or_b(0x02, &PADRH); /* negate _RESET */ + sleep(1); /* > 2ms */ +} + +void ata_address_detect(void) +{ + if (read_hw_mask() & ATA_ADDRESS_200) + { + ata_io_address = 0x200; /* For debug purposes only */ + ata_control = ATA_CONTROL1; + } + else + { + ata_io_address = 0x300; /* For debug purposes only */ + ata_control = ATA_CONTROL2; + } +} + +void ata_enable(bool on) +{ + if(on) + and_b(~0x80, &PADRL); /* enable ATA */ + else + or_b(0x80, &PADRL); /* disable ATA */ + + or_b(0x80, &PAIORL); +} + +void ata_device_init(void) +{ + or_b(0x02, &PAIORH); /* output for ATA reset */ + or_b(0x02, &PADRH); /* release ATA reset */ + PACR2 &= 0xBFFF; /* GPIO function for PA7 (IDE enable) */ +} + +bool ata_is_coldstart(void) +{ + return (PACR2 & 0x4000) != 0; +} diff --git a/firmware/target/sh/archos/ata-as-archos.S b/firmware/target/sh/archos/ata-as-archos.S new file mode 100755 index 0000000000..4a4e7e4b94 --- /dev/null +++ b/firmware/target/sh/archos/ata-as-archos.S @@ -0,0 +1,231 @@ +/*************************************************************************** + * __________ __ ___. + * Open \______ \ ____ ____ | | _\_ |__ _______ ___ + * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / + * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < + * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ + * \/ \/ \/ \/ \/ + * $Id$ + * + * Copyright (C) 2004-2006 by Jens Arnold + * + * All files in this archive are subject to the GNU General Public License. + * See the file COPYING in the source tree root for full license agreement. + * + * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY + * KIND, either express or implied. + * + ****************************************************************************/ + + .section .icode,"ax",@progbits + + .align 2 + .global _copy_read_sectors + .type _copy_read_sectors,@function + +/* Read a number of words from the ATA data port + * + * Assumes wordcount to be a multiple of 4 + * + * Arguments: + * r4 - buffer address + * r5 - word count + * + * Register usage: + * r0 - scratch + * r1/r2 - read buffers + * r3 - mask (if unaligned) + * r4 - current address + * r5 - end address + * r6 - ata port + */ + +_copy_read_sectors: + add r5, r5 /* words -> bytes */ + add r4, r5 /* bytes -> end address */ + add #-12, r5 /* adjust for offsets */ + mov.l .ata_data, r6 + + mov r4, r0 + tst #1, r0 /* 16-bit aligned ? */ + bt .r_aligned /* yes, do word copy */ + + /* not 16-bit aligned */ + mov #-1, r3 /* prepare a bit mask for high byte */ + shll8 r3 /* r3 = 0xFFFFFF00 */ + + mov.w @r6, r2 /* read first word (1st round) */ + mov.b r2, @r4 /* store low byte of first word */ + bra .r_start_b /* jump into loop after next instr. */ + add #-5, r4 /* adjust for dest. offsets; now even */ + + .align 2 +.r_loop_b: /* main loop: copy 4 words in a row */ + mov.w @r6, r2 /* read first word (2+ round) */ + and r3, r1 /* get high byte of fourth word (2+ round) */ + extu.b r2, r0 /* get low byte of first word (2+ round) */ + or r1, r0 /* combine with high byte of fourth word */ + mov.w r0, @(4, r4) /* store at buf[4] */ + nop /* maintain alignment */ +.r_start_b: + mov.w @r6, r1 /* read second word */ + and r3, r2 /* get high byte of first word */ + extu.b r1, r0 /* get low byte of second word */ + or r2, r0 /* combine with high byte of first word */ + mov.w r0, @(6, r4) /* store at buf[6] */ + add #8, r4 /* buf += 8 */ + mov.w @r6, r2 /* read third word */ + and r3, r1 /* get high byte of second word */ + extu.b r2, r0 /* get low byte of third word */ + or r1, r0 /* combine with high byte of second word */ + mov.w r0, @r4 /* store at buf[0] */ + cmp/hi r4, r5 /* check for end */ + mov.w @r6, r1 /* read fourth word */ + and r3, r2 /* get high byte of third word */ + extu.b r1, r0 /* get low byte of fourth word */ + or r2, r0 /* combine with high byte of third word */ + mov.w r0, @(2, r4) /* store at buf[2] */ + bt .r_loop_b + /* 24 instructions for 4 copies, takes 30 clock cycles (4 wait) */ + /* avg. 7.5 cycles per word */ + + swap.b r1, r0 /* get high byte of last word */ + rts + mov.b r0, @(4, r4) /* and store it */ + + /* 16-bit aligned, loop(read and store word) */ +.r_aligned: + mov.w @r6, r2 /* read first word (1st round) */ + bra .r_start_w /* jump into loop after next instr. */ + add #-6, r4 /* adjust for destination offsets */ + + .align 2 +.r_loop_w: /* main loop: copy 4 words in a row */ + mov.w @r6, r2 /* read first word (2+ round) */ + swap.b r1, r0 /* swap fourth word (2+ round) */ + mov.w r0, @(4, r4) /* store fourth word (2+ round) */ + nop /* maintain alignment */ +.r_start_w: + mov.w @r6, r1 /* read second word */ + swap.b r2, r0 /* swap first word */ + mov.w r0, @(6, r4) /* store first word in buf[6] */ + add #8, r4 /* buf += 8 */ + mov.w @r6, r2 /* read third word */ + swap.b r1, r0 /* swap second word */ + mov.w r0, @r4 /* store second word in buf[0] */ + cmp/hi r4, r5 /* check for end */ + mov.w @r6, r1 /* read fourth word */ + swap.b r2, r0 /* swap third word */ + mov.w r0, @(2, r4) /* store third word */ + bt .r_loop_w + /* 16 instructions for 4 copies, takes 22 clock cycles (4 wait) */ + /* avg. 5.5 cycles per word */ + + swap.b r1, r0 /* swap fourth word (last round) */ + rts + mov.w r0, @(4, r4) /* and store it */ + +.r_end: + .size _copy_read_sectors,.r_end-_copy_read_sectors + + .align 2 + .global _copy_write_sectors + .type _copy_write_sectors,@function + +/* Write a number of words to the ATA data port + * + * Assumes wordcount to be a multiple of 2. + * Writing is not unrolled as much as reading, for several reasons: + * + * - a similar instruction sequence is faster for writing than for reading + * because the auto-incrementing load inctructions can be used + * - writing profits from warp mode + * + * Both of these add up to have writing faster than the more unrolled reading. + * + * Arguments: + * r4 - buffer address + * r5 - word count + * + * Register usage: + * r0/r1 - scratch + * r2/r3 - write buffers + * r4 - current address + * r5 - end address + * r6 - mask (if unaligned) + * r7 - ata port + */ + +_copy_write_sectors: + add r5, r5 /* words -> bytes */ + add r4, r5 /* bytes -> end address */ + add #-4, r5 /* adjust for offsets */ + mov.l .ata_data, r7 + + mov r4, r0 + tst #1, r0 /* 16-bit aligned ? */ + bt .w_aligned /* yes, do word copy */ + + /* not 16-bit aligned */ + mov #-1, r6 /* prepare a bit mask for high byte */ + shll8 r6 /* r6 = 0xFFFFFF00 */ + + mov.b @r4+, r2 /* load (initial old second) first byte */ + mov.w @r4+, r3 /* load (initial) first word */ + bra .w_start_b + extu.b r2, r0 /* extend unsigned */ + + .align 2 +.w_loop_b: /* main loop: copy 2 words in a row */ + mov.w @r4+, r3 /* load first word (2+ round) */ + extu.b r2, r0 /* put away low byte of second word (2+ round) */ + and r6, r2 /* get high byte of second word (2+ round) */ + or r1, r2 /* combine with low byte of old first word */ + mov.w r2, @r7 /* write that */ +.w_start_b: + cmp/hi r4, r5 /* check for end */ + mov.w @r4+, r2 /* load second word */ + extu.b r3, r1 /* put away low byte of first word */ + and r6, r3 /* get high byte of first word */ + or r0, r3 /* combine with high byte of old second word */ + mov.w r3, @r7 /* write that */ + bt .w_loop_b + /* 12 instructions for 2 copies, takes 14 clock cycles */ + /* avg. 7 cycles per word */ + + /* the loop "overreads" 1 byte past the buffer end, however, the last */ + /* byte is not written to disk */ + and r6, r2 /* get high byte of last word */ + or r1, r2 /* combine with low byte of old first word */ + rts + mov.w r2, @r7 /* write last word */ + + /* 16-bit aligned, loop(load and write word) */ +.w_aligned: + bra .w_start_w /* jump into loop after next instr. */ + mov.w @r4+, r2 /* load first word (1st round) */ + + .align 2 +.w_loop_w: /* main loop: copy 2 words in a row */ + mov.w @r4+, r2 /* load first word (2+ round) */ + swap.b r1, r0 /* swap second word (2+ round) */ + mov.w r0, @r7 /* write second word (2+ round) */ +.w_start_w: + cmp/hi r4, r5 /* check for end */ + mov.w @r4+, r1 /* load second word */ + swap.b r2, r0 /* swap first word */ + mov.w r0, @r7 /* write first word */ + bt .w_loop_w + /* 8 instructions for 2 copies, takes 10 clock cycles */ + /* avg. 5 cycles per word */ + + swap.b r1, r0 /* swap second word (last round) */ + rts + mov.w r0, @r7 /* and write it */ + +.w_end: + .size _copy_write_sectors,.w_end-_copy_write_sectors + + .align 2 +.ata_data: + .long 0x06104100 /* ATA data port */ diff --git a/firmware/target/sh/archos/ata-target.h b/firmware/target/sh/archos/ata-target.h new file mode 100755 index 0000000000..ddffb34f5a --- /dev/null +++ b/firmware/target/sh/archos/ata-target.h @@ -0,0 +1,80 @@ +/*************************************************************************** + * __________ __ ___. + * Open \______ \ ____ ____ | | _\_ |__ _______ ___ + * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / + * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < + * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ + * \/ \/ \/ \/ \/ + * $Id$ + * + * Copyright (C) 2006 by Jens Arnold + * + * All files in this archive are subject to the GNU General Public License. + * See the file COPYING in the source tree root for full license agreement. + * + * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY + * KIND, either express or implied. + * + ****************************************************************************/ +#ifndef ATA_TARGET_H +#define ATA_TARGET_H + +/* asm optimised read & write loops */ +#define ATA_OPTIMIZED_READING +#define ATA_OPTIMIZED_WRITING +#define ATA_ADDRESS_DETECT /* need address detection */ + +#define SWAP_WORDS + +#define ATA_IOBASE 0x06100100 +#define ATA_DATA (*((volatile unsigned short*)0x06104100)) +#define ATA_CONTROL1 ((volatile unsigned char*)0x06200206) +#define ATA_CONTROL2 ((volatile unsigned char*)0x06200306) +#define ATA_CONTROL (*ata_control) + +#define ATA_ERROR (*((volatile unsigned char*)ATA_IOBASE + 1)) +#define ATA_NSECTOR (*((volatile unsigned char*)ATA_IOBASE + 2)) +#define ATA_SECTOR (*((volatile unsigned char*)ATA_IOBASE + 3)) +#define ATA_LCYL (*((volatile unsigned char*)ATA_IOBASE + 4)) +#define ATA_HCYL (*((volatile unsigned char*)ATA_IOBASE + 5)) +#define ATA_SELECT (*((volatile unsigned char*)ATA_IOBASE + 6)) +#define ATA_COMMAND (*((volatile unsigned char*)ATA_IOBASE + 7)) + +#define STATUS_BSY 0x80 +#define STATUS_RDY 0x40 +#define STATUS_DF 0x20 +#define STATUS_DRQ 0x08 +#define STATUS_ERR 0x01 + +#define ERROR_ABRT 0x04 + +#define WRITE_PATTERN1 0xa5 +#define WRITE_PATTERN2 0x5a +#define WRITE_PATTERN3 0xaa +#define WRITE_PATTERN4 0x55 + +#define READ_PATTERN1 0xa5 +#define READ_PATTERN2 0x5a +#define READ_PATTERN3 0xaa +#define READ_PATTERN4 0x55 + +#define READ_PATTERN1_MASK 0xff +#define READ_PATTERN2_MASK 0xff +#define READ_PATTERN3_MASK 0xff +#define READ_PATTERN4_MASK 0xff + +#define SET_REG(reg,val) reg = (val) +#define SET_16BITREG(reg,val) reg = (val) + +extern volatile unsigned char* ata_control; +extern int ata_io_address; + +void ata_reset(void); +void ata_address_detect(void); +void ata_enable(bool on); +void ata_device_init(void); +bool ata_is_coldstart(void); + +void copy_read_sectors(unsigned char* buf, int wordcount); +void copy_write_sectors(const unsigned char* buf, int wordcount); +#endif -- cgit v1.2.3