Lines Matching refs:num
26 u8 sil3114_spin_up (int num);
27 u8 sil3114_spin_down (int num);
28 static int sata_bus_softreset (int num);
29 static void sata_identify (int num, int dev);
30 static u8 check_power_mode (int num);
32 static void set_Feature_cmd (int num, int dev);
57 static int sata_bus_softreset (int num) in sata_bus_softreset() argument
61 port[num].dev_mask = 1; in sata_bus_softreset()
63 port[num].ctl_reg = 0x08; /*Default value of control reg */ in sata_bus_softreset()
64 writeb (port[num].ctl_reg, port[num].ioaddr.ctl_addr); in sata_bus_softreset()
66 writeb (port[num].ctl_reg | ATA_SRST, port[num].ioaddr.ctl_addr); in sata_bus_softreset()
68 writeb (port[num].ctl_reg, port[num].ioaddr.ctl_addr); in sata_bus_softreset()
79 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 300, 0); in sata_bus_softreset()
82 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 3, 0); in sata_bus_softreset()
86 printf ("ata%u is slow to respond,plz be patient\n", num); in sata_bus_softreset()
91 status = sata_chk_status (&port[num].ioaddr, 0); in sata_bus_softreset()
95 printf ("ata%u failed to respond : ", num); in sata_bus_softreset()
97 port[num].dev_mask = 0; in sata_bus_softreset()
103 static void sata_identify (int num, int dev) in sata_identify() argument
105 u8 cmd = 0, status = 0, devno = num; in sata_identify()
111 if (!(port[num].dev_mask & 0x01)) { in sata_identify()
112 printf ("dev%d is not present on port#%d\n", dev, num); in sata_identify()
116 debug ("port=%d dev=%d\n", num, dev); in sata_identify()
120 writeb (cmd, port[num].ioaddr.command_addr); in sata_identify()
121 readb (port[num].ioaddr.altstatus_addr); in sata_identify()
124 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 1000, 0); in sata_identify()
127 port[num].dev_mask &= ~0x01; in sata_identify()
131 input_data (&port[num].ioaddr, iobuf, ATA_SECTOR_WORDS); in sata_identify()
139 debug ("ata%u: no dma/lba\n", num); in sata_identify()
147 port[num].dev_mask &= ~0x01; in sata_identify()
177 static void set_Feature_cmd (int num, int dev) in set_Feature_cmd() argument
181 if (!(port[num].dev_mask & 0x01)) { in set_Feature_cmd()
182 debug ("dev%d is not present on port#%d\n", dev, num); in set_Feature_cmd()
186 writeb (SETFEATURES_XFER, port[num].ioaddr.feature_addr); in set_Feature_cmd()
187 writeb (XFER_PIO_4, port[num].ioaddr.nsect_addr); in set_Feature_cmd()
188 writeb (0, port[num].ioaddr.lbal_addr); in set_Feature_cmd()
189 writeb (0, port[num].ioaddr.lbam_addr); in set_Feature_cmd()
190 writeb (0, port[num].ioaddr.lbah_addr); in set_Feature_cmd()
192 writeb (ATA_DEVICE_OBS, port[num].ioaddr.device_addr); in set_Feature_cmd()
193 writeb (ATA_CMD_SET_FEATURES, port[num].ioaddr.command_addr); in set_Feature_cmd()
198 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 5000, 0); in set_Feature_cmd()
201 port[num].dev_mask &= ~0x01; in set_Feature_cmd()
205 u8 sil3114_spin_down (int num) in sil3114_spin_down() argument
211 if (!(port[num].dev_mask & 0x01)) { in sil3114_spin_down()
212 debug ("Device ata%d is not present\n", num); in sil3114_spin_down()
216 if ((status = check_power_mode (num)) == 0x00) { in sil3114_spin_down()
222 printf ("Failed to check power mode on ata%d\n", num); in sil3114_spin_down()
226 if (!((status = sata_chk_status (&port[num].ioaddr, 0)) & ATA_DRDY)) { in sil3114_spin_down()
227 printf ("Device ata%d not ready\n", num); in sil3114_spin_down()
231 writeb (0x00, port[num].ioaddr.feature_addr); in sil3114_spin_down()
233 writeb (0x00, port[num].ioaddr.nsect_addr); in sil3114_spin_down()
234 writeb (0x00, port[num].ioaddr.lbal_addr); in sil3114_spin_down()
235 writeb (0x00, port[num].ioaddr.lbam_addr); in sil3114_spin_down()
236 writeb (0x00, port[num].ioaddr.lbah_addr); in sil3114_spin_down()
238 writeb (ATA_DEVICE_OBS, port[num].ioaddr.device_addr); in sil3114_spin_down()
239 writeb (ATA_CMD_STANDBY, port[num].ioaddr.command_addr); in sil3114_spin_down()
241 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 30000, 0); in sil3114_spin_down()
245 port[num].dev_mask &= ~0x01; in sil3114_spin_down()
251 u8 sil3114_spin_up (int num) in sil3114_spin_up() argument
257 if (!(port[num].dev_mask & 0x01)) { in sil3114_spin_up()
258 debug ("Device ata%d is not present\n", num); in sil3114_spin_up()
262 if ((status = check_power_mode (num)) != 0x00) { in sil3114_spin_up()
264 printf ("Failed to check power mode on ata%d\n", num); in sil3114_spin_up()
272 if (!((status = sata_chk_status (&port[num].ioaddr, 0)) & ATA_DRDY)) { in sil3114_spin_up()
273 printf ("Device ata%d not ready\n", num); in sil3114_spin_up()
279 writeb (0x00, port[num].ioaddr.feature_addr); in sil3114_spin_up()
281 writeb (0x00, port[num].ioaddr.nsect_addr); in sil3114_spin_up()
282 writeb (0x00, port[num].ioaddr.lbal_addr); in sil3114_spin_up()
283 writeb (0x00, port[num].ioaddr.lbam_addr); in sil3114_spin_up()
284 writeb (0x00, port[num].ioaddr.lbah_addr); in sil3114_spin_up()
286 writeb (ATA_DEVICE_OBS, port[num].ioaddr.device_addr); in sil3114_spin_up()
287 writeb (ATA_CMD_IDLE, port[num].ioaddr.command_addr); in sil3114_spin_up()
289 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 30000, 0); in sil3114_spin_up()
293 port[num].dev_mask &= ~0x01; in sil3114_spin_up()
300 status = check_power_mode (num); in sil3114_spin_up()
317 static u8 check_power_mode (int num) in check_power_mode() argument
321 if (!(port[num].dev_mask & 0x01)) { in check_power_mode()
322 debug ("Device ata%d is not present\n", num); in check_power_mode()
326 if (!(sata_chk_status (&port[num].ioaddr, 0) & ATA_DRDY)) { in check_power_mode()
327 printf ("Device ata%d not ready\n", num); in check_power_mode()
331 writeb (0, port[num].ioaddr.feature_addr); in check_power_mode()
332 writeb (0, port[num].ioaddr.nsect_addr); in check_power_mode()
333 writeb (0, port[num].ioaddr.lbal_addr); in check_power_mode()
334 writeb (0, port[num].ioaddr.lbam_addr); in check_power_mode()
335 writeb (0, port[num].ioaddr.lbah_addr); in check_power_mode()
337 writeb (ATA_DEVICE_OBS, port[num].ioaddr.device_addr); in check_power_mode()
338 writeb (ATA_CMD_CHK_POWER, port[num].ioaddr.command_addr); in check_power_mode()
340 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 5000, 0); in check_power_mode()
345 port[num].dev_mask &= ~0x01; in check_power_mode()
348 res = readb (port[num].ioaddr.nsect_addr); in check_power_mode()
368 static u8 wait_for_irq (int num, unsigned int max) in wait_for_irq() argument
372 switch (num) { in wait_for_irq()
555 unsigned char status = 0, num = 0; in sata_write() local
570 num = device; in sata_write()
573 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 500, 0); in sata_write()
575 printf ("ata%u failed to respond\n", port[num].port_no); in sata_write()
581 writeb (0, port[num].ioaddr.nsect_addr); in sata_write()
583 port[num].ioaddr.lbal_addr); in sata_write()
585 port[num].ioaddr.lbam_addr); in sata_write()
587 port[num].ioaddr.lbah_addr); in sata_write()
590 writeb (1, port[num].ioaddr.nsect_addr); in sata_write()
591 writeb ((blknr >> 0) & 0xFF, port[num].ioaddr.lbal_addr); in sata_write()
592 writeb ((blknr >> 8) & 0xFF, port[num].ioaddr.lbam_addr); in sata_write()
593 writeb ((blknr >> 16) & 0xFF, port[num].ioaddr.lbah_addr); in sata_write()
596 writeb (ATA_LBA, port[num].ioaddr.device_addr); in sata_write()
597 writeb (ATA_CMD_PIO_WRITE_EXT, port[num].ioaddr.command_addr); in sata_write()
602 port[num].ioaddr.device_addr); in sata_write()
603 writeb (ATA_CMD_PIO_WRITE, port[num].ioaddr.command_addr); in sata_write()
608 status = sata_busy_wait (&port[num].ioaddr, ATA_BUSY, 4000, 0); in sata_write()
615 output_data (&port[num].ioaddr, buffer, ATA_SECTOR_WORDS); in sata_write()
616 readb (port[num].ioaddr.altstatus_addr); in sata_write()