Merge branch 'makefile' into haiku
[grub2/phcoder.git] / disk / ata_pthru.c
blob68edca7ea19ecd8dc9feda968c6efc6cab697b1f
1 /* ata_pthru.c - ATA pass through for ata.mod. */
2 /*
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/>.
20 #include <grub/ata.h>
21 #include <grub/disk.h>
22 #include <grub/dl.h>
23 #include <grub/mm.h>
26 /* ATA pass through support, used by hdparm.mod. */
27 static grub_err_t
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;
32 int i;
33 grub_int8_t sts;
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);
52 /* Set registers. */
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))
56 return grub_errno;
58 for (i = GRUB_ATA_REG_FEATURES; i <= GRUB_ATA_REG_LBAHIGH; i++)
59 grub_ata_regset (dev, i, parms->taskfile[i]);
61 /* Start command. */
62 grub_ata_regset (dev, GRUB_ATA_REG_CMD, parms->taskfile[GRUB_ATA_REG_CMD]);
64 /* Wait for !BSY. */
65 if (grub_ata_wait_not_busy (dev, GRUB_ATA_TOUT_DATA))
66 return grub_errno;
68 /* Check status. */
69 sts = grub_ata_regget (dev, GRUB_ATA_REG_STATUS);
70 grub_dprintf ("ata", "status=0x%x\n", sts);
72 /* Transfer data. */
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");
93 return GRUB_ERR_NONE;
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;