1 /* ata_pthru.c - ATA pass through for ata.mod. */
3 * GRUB -- GRand Unified Bootloader
4 * Copyright (C) 2009 Free Software Foundation, Inc.
6 * GRUB is free software: you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation, either version 3 of the License, or
9 * (at your option) any later version.
11 * GRUB is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with GRUB. If not, see <http://www.gnu.org/licenses/>.
21 #include <grub/disk.h>
26 /* ATA pass through support, used by hdparm.mod. */
28 grub_ata_pass_through (grub_disk_t disk
,
29 struct grub_disk_ata_pass_through_parms
*parms
)
31 struct grub_ata_device
*dev
= (struct grub_ata_device
*) disk
->data
;
35 if (disk
->dev
->id
!= GRUB_DISK_DEVICE_ATA_ID
)
36 return grub_error (GRUB_ERR_BAD_DEVICE
,
37 "Device not accessed via ata.mod");
39 if (! (parms
->size
== 0 || parms
->size
== GRUB_DISK_SECTOR_SIZE
))
40 return grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET
,
41 "ATA multi-sector read and DATA OUT not implemented");
43 grub_dprintf ("ata", "ata_pass_through: cmd=0x%x, features=0x%x, sectors=0x%x\n",
44 parms
->taskfile
[GRUB_ATA_REG_CMD
],
45 parms
->taskfile
[GRUB_ATA_REG_FEATURES
],
46 parms
->taskfile
[GRUB_ATA_REG_SECTORS
]);
47 grub_dprintf ("ata", "lba_high=0x%x, lba_mid=0x%x, lba_low=0x%x, size=%d\n",
48 parms
->taskfile
[GRUB_ATA_REG_LBAHIGH
],
49 parms
->taskfile
[GRUB_ATA_REG_LBAMID
],
50 parms
->taskfile
[GRUB_ATA_REG_LBALOW
], parms
->size
);
53 grub_ata_regset (dev
, GRUB_ATA_REG_DISK
, 0xE0 | dev
->device
<< 4
54 | (parms
->taskfile
[GRUB_ATA_REG_DISK
] & 0xf));
55 if (grub_ata_check_ready (dev
))
58 for (i
= GRUB_ATA_REG_FEATURES
; i
<= GRUB_ATA_REG_LBAHIGH
; i
++)
59 grub_ata_regset (dev
, i
, parms
->taskfile
[i
]);
62 grub_ata_regset (dev
, GRUB_ATA_REG_CMD
, parms
->taskfile
[GRUB_ATA_REG_CMD
]);
65 if (grub_ata_wait_not_busy (dev
, GRUB_ATA_TOUT_DATA
))
69 sts
= grub_ata_regget (dev
, GRUB_ATA_REG_STATUS
);
70 grub_dprintf ("ata", "status=0x%x\n", sts
);
73 if ((sts
& (GRUB_ATA_STATUS_DRQ
| GRUB_ATA_STATUS_ERR
)) == GRUB_ATA_STATUS_DRQ
)
75 if (parms
->size
!= GRUB_DISK_SECTOR_SIZE
)
76 return grub_error (GRUB_ERR_READ_ERROR
, "DRQ unexpected");
77 grub_ata_pio_read (dev
, parms
->buffer
, GRUB_DISK_SECTOR_SIZE
);
80 /* Return registers. */
81 for (i
= GRUB_ATA_REG_ERROR
; i
<= GRUB_ATA_REG_STATUS
; i
++)
82 parms
->taskfile
[i
] = grub_ata_regget (dev
, i
);
84 grub_dprintf ("ata", "status=0x%x, error=0x%x, sectors=0x%x\n",
85 parms
->taskfile
[GRUB_ATA_REG_STATUS
],
86 parms
->taskfile
[GRUB_ATA_REG_ERROR
],
87 parms
->taskfile
[GRUB_ATA_REG_SECTORS
]);
89 if (parms
->taskfile
[GRUB_ATA_REG_STATUS
]
90 & (GRUB_ATA_STATUS_DRQ
| GRUB_ATA_STATUS_ERR
))
91 return grub_error (GRUB_ERR_READ_ERROR
, "ATA passthrough failed");
98 GRUB_MOD_INIT(ata_pthru
)
100 /* Register ATA pass through function. */
101 grub_disk_ata_pass_through
= grub_ata_pass_through
;
104 GRUB_MOD_FINI(ata_pthru
)
106 if (grub_disk_ata_pass_through
== grub_ata_pass_through
)
107 grub_disk_ata_pass_through
= NULL
;