devs/foxbox
1
0
Fork 0
forked from len0rd/rockbox
Code Pull requests Activity

Check for master/slave disk. Active 5s spindown timeout.

Browse source 
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@655 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Björn Stenberg 2002-05-22 14:37:36 +00:00
parent 7785d55483
commit 5c7847c501
1 changed files with 35 additions and 6 deletions
Download patch file Download diff file Expand all files Collapse all files

41
firmware/drivers/ata.c
View file

@ -37,6 +37,7 @@
#define ATA_CONTROL (*((volatile unsigned char*)0x06200306)) #define ATA_CONTROL (*((volatile unsigned char*)0x06200306))
#define ATA_ALT_STATUS ATA_CONTROL #define ATA_ALT_STATUS ATA_CONTROL
#define SELECT_DEVICE1 0x10
#define SELECT_LBA 0x40 #define SELECT_LBA 0x40
#define STATUS_BSY 0x80 #define STATUS_BSY 0x80
@ -54,7 +55,8 @@
#define CMD_SLEEP 0xE6 #define CMD_SLEEP 0xE6
#define CMD_SECURITY_FREEZE_LOCK 0xF5 #define CMD_SECURITY_FREEZE_LOCK 0xF5
struct mutex ata_mtx; static struct mutex ata_mtx;
static char device; /* device 0 (master) or 1 (slave) */
static int wait_for_bsy(void) static int wait_for_bsy(void)
{ {
@ -114,7 +116,7 @@ int ata_read_sectors(unsigned long start,
ATA_SECTOR = start & 0xff; ATA_SECTOR = start & 0xff;
ATA_LCYL = (start >> 8) & 0xff; ATA_LCYL = (start >> 8) & 0xff;
ATA_HCYL = (start >> 16) & 0xff; ATA_HCYL = (start >> 16) & 0xff;
ATA_SELECT = ((start >> 24) & 0xf) | SELECT_LBA; ATA_SELECT = ((start >> 24) & 0xf) | SELECT_LBA | device;
ATA_COMMAND = CMD_READ_SECTORS; ATA_COMMAND = CMD_READ_SECTORS;
for (i=0; i<count; i++) { for (i=0; i<count; i++) {
@ -164,7 +166,7 @@ int ata_write_sectors(unsigned long start,
ATA_SECTOR = start & 0xff; ATA_SECTOR = start & 0xff;
ATA_LCYL = (start >> 8) & 0xff; ATA_LCYL = (start >> 8) & 0xff;
ATA_HCYL = (start >> 16) & 0xff; ATA_HCYL = (start >> 16) & 0xff;
ATA_SELECT = ((start >> 24) & 0xf) | SELECT_LBA; ATA_SELECT = ((start >> 24) & 0xf) | SELECT_LBA | device;
ATA_COMMAND = CMD_WRITE_SECTORS; ATA_COMMAND = CMD_WRITE_SECTORS;
for (i=0; i<count; i++) { for (i=0; i<count; i++) {
@ -289,7 +291,7 @@ int ata_soft_reset(void)
mutex_lock(&ata_mtx); mutex_lock(&ata_mtx);
ATA_SELECT = SELECT_LBA; ATA_SELECT = SELECT_LBA | device;
ATA_CONTROL = CONTROL_nIEN|CONTROL_SRST; ATA_CONTROL = CONTROL_nIEN|CONTROL_SRST;
sleep(HZ/20000); /* >= 5us */ sleep(HZ/20000); /* >= 5us */
@ -302,6 +304,27 @@ int ata_soft_reset(void)
return ret; return ret;
} }
static int master_slave(void)
{
/* master? */
ATA_SELECT = 0;
if ( ATA_STATUS & STATUS_RDY ) {
device = 0;
DEBUGF("Found master harddisk\n");
}
else {
/* slave? */
ATA_SELECT = SELECT_DEVICE1;
if ( ATA_STATUS & STATUS_RDY ) {
device = SELECT_DEVICE1;
DEBUGF("Found slave harddisk\n");
}
else
return -1;
}
return 0;
}
int ata_init(void) int ata_init(void)
{ {
mutex_init(&ata_mtx); mutex_init(&ata_mtx);
@ -311,15 +334,21 @@ int ata_init(void)
/* activate ATA */ /* activate ATA */
PADR &= ~0x80; PADR &= ~0x80;
if (!ata_hard_reset()) if (master_slave())
return -1; return -1;
if (!ata_hard_reset())
return -2;
if (!check_registers()) if (!check_registers())
return -2; return -3;
if (freeze_lock() < 0) if (freeze_lock() < 0)
return -4; return -4;
if (ata_spindown(1) < 0)
return -5;
ATA_SELECT = SELECT_LBA; ATA_SELECT = SELECT_LBA;
ATA_CONTROL = CONTROL_nIEN; ATA_CONTROL = CONTROL_nIEN;