Lines Matching refs:num
25 u8 sil3114_spin_up (int num);
26 u8 sil3114_spin_down (int num);
27 static int sata_bus_softreset (int num);
28 static void sata_identify (int num, int dev);
29 static u8 check_power_mode (int num);
31 static void set_Feature_cmd (int num, int dev);
56 static int sata_bus_softreset (int num) in sata_bus_softreset() argument
60 port[num].dev_mask = 1; in sata_bus_softreset()
62 port[num].ctl_reg = 0x08; /*Default value of control reg */ in sata_bus_softreset()
63 writeb (port[num].ctl_reg, port[num].ioaddr.ctl_addr); in sata_bus_softreset()
65 writeb (port[num].ctl_reg | ATA_SRST, port[num].ioaddr.ctl_addr); in sata_bus_softreset()
67 writeb (port[num].ctl_reg, port[num].ioaddr.ctl_addr); in sata_bus_softreset()
78 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 300, 0); in sata_bus_softreset()
81 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 3, 0); in sata_bus_softreset()
85 printf ("ata%u is slow to respond,plz be patient\n", num); in sata_bus_softreset()
90 status = sata_chk_status (&port[num].ioaddr, 0); in sata_bus_softreset()
94 printf ("ata%u failed to respond : ", num); in sata_bus_softreset()
96 port[num].dev_mask = 0; in sata_bus_softreset()
102 static void sata_identify (int num, int dev) in sata_identify() argument
104 u8 cmd = 0, status = 0, devno = num; in sata_identify()
110 if (!(port[num].dev_mask & 0x01)) { in sata_identify()
111 printf ("dev%d is not present on port#%d\n", dev, num); in sata_identify()
115 debug ("port=%d dev=%d\n", num, dev); in sata_identify()
119 writeb (cmd, port[num].ioaddr.command_addr); in sata_identify()
120 readb (port[num].ioaddr.altstatus_addr); in sata_identify()
123 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 1000, 0); in sata_identify()
126 port[num].dev_mask &= ~0x01; in sata_identify()
130 input_data (&port[num].ioaddr, iobuf, ATA_SECTOR_WORDS); in sata_identify()
138 debug ("ata%u: no dma/lba\n", num); in sata_identify()
146 port[num].dev_mask &= ~0x01; in sata_identify()
176 static void set_Feature_cmd (int num, int dev) in set_Feature_cmd() argument
180 if (!(port[num].dev_mask & 0x01)) { in set_Feature_cmd()
181 debug ("dev%d is not present on port#%d\n", dev, num); in set_Feature_cmd()
185 writeb (SETFEATURES_XFER, port[num].ioaddr.feature_addr); in set_Feature_cmd()
186 writeb (XFER_PIO_4, port[num].ioaddr.nsect_addr); in set_Feature_cmd()
187 writeb (0, port[num].ioaddr.lbal_addr); in set_Feature_cmd()
188 writeb (0, port[num].ioaddr.lbam_addr); in set_Feature_cmd()
189 writeb (0, port[num].ioaddr.lbah_addr); in set_Feature_cmd()
191 writeb (ATA_DEVICE_OBS, port[num].ioaddr.device_addr); in set_Feature_cmd()
192 writeb (ATA_CMD_SET_FEATURES, port[num].ioaddr.command_addr); in set_Feature_cmd()
197 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 5000, 0); in set_Feature_cmd()
200 port[num].dev_mask &= ~0x01; in set_Feature_cmd()
204 u8 sil3114_spin_down (int num) in sil3114_spin_down() argument
210 if (!(port[num].dev_mask & 0x01)) { in sil3114_spin_down()
211 debug ("Device ata%d is not present\n", num); in sil3114_spin_down()
215 if ((status = check_power_mode (num)) == 0x00) { in sil3114_spin_down()
221 printf ("Failed to check power mode on ata%d\n", num); in sil3114_spin_down()
225 if (!((status = sata_chk_status (&port[num].ioaddr, 0)) & ATA_DRDY)) { in sil3114_spin_down()
226 printf ("Device ata%d not ready\n", num); in sil3114_spin_down()
230 writeb (0x00, port[num].ioaddr.feature_addr); in sil3114_spin_down()
232 writeb (0x00, port[num].ioaddr.nsect_addr); in sil3114_spin_down()
233 writeb (0x00, port[num].ioaddr.lbal_addr); in sil3114_spin_down()
234 writeb (0x00, port[num].ioaddr.lbam_addr); in sil3114_spin_down()
235 writeb (0x00, port[num].ioaddr.lbah_addr); in sil3114_spin_down()
237 writeb (ATA_DEVICE_OBS, port[num].ioaddr.device_addr); in sil3114_spin_down()
238 writeb (ATA_CMD_STANDBY, port[num].ioaddr.command_addr); in sil3114_spin_down()
240 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 30000, 0); in sil3114_spin_down()
244 port[num].dev_mask &= ~0x01; in sil3114_spin_down()
250 u8 sil3114_spin_up (int num) in sil3114_spin_up() argument
256 if (!(port[num].dev_mask & 0x01)) { in sil3114_spin_up()
257 debug ("Device ata%d is not present\n", num); in sil3114_spin_up()
261 if ((status = check_power_mode (num)) != 0x00) { in sil3114_spin_up()
263 printf ("Failed to check power mode on ata%d\n", num); in sil3114_spin_up()
271 if (!((status = sata_chk_status (&port[num].ioaddr, 0)) & ATA_DRDY)) { in sil3114_spin_up()
272 printf ("Device ata%d not ready\n", num); in sil3114_spin_up()
278 writeb (0x00, port[num].ioaddr.feature_addr); in sil3114_spin_up()
280 writeb (0x00, port[num].ioaddr.nsect_addr); in sil3114_spin_up()
281 writeb (0x00, port[num].ioaddr.lbal_addr); in sil3114_spin_up()
282 writeb (0x00, port[num].ioaddr.lbam_addr); in sil3114_spin_up()
283 writeb (0x00, port[num].ioaddr.lbah_addr); in sil3114_spin_up()
285 writeb (ATA_DEVICE_OBS, port[num].ioaddr.device_addr); in sil3114_spin_up()
286 writeb (ATA_CMD_IDLE, port[num].ioaddr.command_addr); in sil3114_spin_up()
288 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 30000, 0); in sil3114_spin_up()
292 port[num].dev_mask &= ~0x01; in sil3114_spin_up()
299 status = check_power_mode (num); in sil3114_spin_up()
316 static u8 check_power_mode (int num) in check_power_mode() argument
320 if (!(port[num].dev_mask & 0x01)) { in check_power_mode()
321 debug ("Device ata%d is not present\n", num); in check_power_mode()
325 if (!(sata_chk_status (&port[num].ioaddr, 0) & ATA_DRDY)) { in check_power_mode()
326 printf ("Device ata%d not ready\n", num); in check_power_mode()
330 writeb (0, port[num].ioaddr.feature_addr); in check_power_mode()
331 writeb (0, port[num].ioaddr.nsect_addr); in check_power_mode()
332 writeb (0, port[num].ioaddr.lbal_addr); in check_power_mode()
333 writeb (0, port[num].ioaddr.lbam_addr); in check_power_mode()
334 writeb (0, port[num].ioaddr.lbah_addr); in check_power_mode()
336 writeb (ATA_DEVICE_OBS, port[num].ioaddr.device_addr); in check_power_mode()
337 writeb (ATA_CMD_CHK_POWER, port[num].ioaddr.command_addr); in check_power_mode()
339 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 5000, 0); in check_power_mode()
344 port[num].dev_mask &= ~0x01; in check_power_mode()
347 res = readb (port[num].ioaddr.nsect_addr); in check_power_mode()
367 static u8 wait_for_irq (int num, unsigned int max) in wait_for_irq() argument
371 switch (num) { in wait_for_irq()
554 unsigned char status = 0, num = 0; in sata_write() local
569 num = device; in sata_write()
572 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 500, 0); in sata_write()
574 printf ("ata%u failed to respond\n", port[num].port_no); in sata_write()
580 writeb (0, port[num].ioaddr.nsect_addr); in sata_write()
582 port[num].ioaddr.lbal_addr); in sata_write()
584 port[num].ioaddr.lbam_addr); in sata_write()
586 port[num].ioaddr.lbah_addr); in sata_write()
589 writeb (1, port[num].ioaddr.nsect_addr); in sata_write()
590 writeb ((blknr >> 0) & 0xFF, port[num].ioaddr.lbal_addr); in sata_write()
591 writeb ((blknr >> 8) & 0xFF, port[num].ioaddr.lbam_addr); in sata_write()
592 writeb ((blknr >> 16) & 0xFF, port[num].ioaddr.lbah_addr); in sata_write()
595 writeb (ATA_LBA, port[num].ioaddr.device_addr); in sata_write()
596 writeb (ATA_CMD_PIO_WRITE_EXT, port[num].ioaddr.command_addr); in sata_write()
601 port[num].ioaddr.device_addr); in sata_write()
602 writeb (ATA_CMD_PIO_WRITE, port[num].ioaddr.command_addr); in sata_write()
607 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 4000, 0); in sata_write()
614 output_data (&port[num].ioaddr, buffer, ATA_SECTOR_WORDS); in sata_write()
615 readb (port[num].ioaddr.altstatus_addr); in sata_write()