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

Bug fix: Master/slave was not always properly selected after powerdown.

Browse source 
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@2910 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Björn Stenberg 2002-12-03 13:29:35 +00:00
parent 4a931c6285
commit c032e65034
1 changed files with 14 additions and 9 deletions
Download patch file Download diff file Expand all files Collapse all files

23
firmware/drivers/ata.c
View file

@ -188,6 +188,7 @@ int ata_read_sectors(unsigned long start,
poweroff = false;
}
ATA_SELECT = ata_device;
if (!wait_for_rdy())
{
mutex_unlock(&ata_mtx);
@ -308,6 +309,7 @@ int ata_write_sectors(unsigned long start,
poweroff = false;
}
ATA_SELECT = ata_device;
if (!wait_for_rdy())
{
mutex_unlock(&ata_mtx);
@ -398,6 +400,8 @@ static int check_registers(void)
static int freeze_lock(void)
{
ATA_SELECT = ata_device;
if (!wait_for_rdy())
return -1;
@ -435,13 +439,14 @@ static int ata_perform_sleep(void)
mutex_lock(&ata_mtx);
ATA_SELECT = ata_device;
if(!wait_for_rdy()) {
DEBUGF("ata_perform_sleep() - not RDY\n");
mutex_unlock(&ata_mtx);
return -1;
}
ATA_SELECT = ata_device;
ATA_COMMAND = CMD_SLEEP;
if (!wait_for_rdy())
@ -537,6 +542,7 @@ int ata_hard_reset(void)
sleep(1); /* > 2ms */
/* state HRR2 */
ATA_SELECT = ata_device; /* select the right device */
ret = wait_for_bsy();
/* Massage the return code so it is 0 on success and -1 on failure */
@ -590,12 +596,12 @@ static int ata_power_on(void)
if( ata_hard_reset() )
return -1;
ATA_SELECT = SELECT_LBA;
ATA_CONTROL = CONTROL_nIEN;
if (set_multiple_mode(multisectors))
return -2;
if (freeze_lock())
return -3;
sleeping = false;
poweroff = false;
return 0;
@ -676,12 +682,13 @@ static int identify(void)
{
int i;
ATA_SELECT = ata_device;
if(!wait_for_rdy()) {
DEBUGF("identify() - not RDY\n");
return -1;
}
ATA_SELECT = ata_device;
ATA_COMMAND = CMD_IDENTIFY;
if (!wait_for_start_of_transfer())
@ -699,12 +706,13 @@ static int identify(void)
static int set_multiple_mode(int sectors)
{
ATA_SELECT = ata_device;
if(!wait_for_rdy()) {
DEBUGF("set_multiple_mode() - not RDY\n");
return -1;
}
ATA_SELECT = ata_device;
ATA_NSECTOR = sectors;
ATA_COMMAND = CMD_SET_MULTIPLE_MODE;
@ -756,8 +764,5 @@ int ata_init(void)
if (set_multiple_mode(multisectors))
return -6;
ATA_SELECT = SELECT_LBA;
ATA_CONTROL = CONTROL_nIEN;
return 0;
}