2 * Copyright (c) 2010 Marcel Moolenaar
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
31 #include <sys/param.h>
33 #include <sys/queue.h>
37 #include <bootstrap.h>
45 static EFI_GUID blkio_guid = BLOCK_IO_PROTOCOL;
47 static int efipart_initfd(void);
48 static int efipart_initcd(void);
49 static int efipart_inithd(void);
51 static int efipart_strategy(void *, int, daddr_t, size_t, char *, size_t *);
52 static int efipart_realstrategy(void *, int, daddr_t, size_t, char *, size_t *);
54 static int efipart_open(struct open_file *, ...);
55 static int efipart_close(struct open_file *);
56 static int efipart_ioctl(struct open_file *, u_long, void *);
58 static int efipart_printfd(int);
59 static int efipart_printcd(int);
60 static int efipart_printhd(int);
62 /* EISA PNP ID's for floppy controllers */
67 struct devsw efipart_fddev = {
70 .dv_init = efipart_initfd,
71 .dv_strategy = efipart_strategy,
72 .dv_open = efipart_open,
73 .dv_close = efipart_close,
74 .dv_ioctl = efipart_ioctl,
75 .dv_print = efipart_printfd,
79 struct devsw efipart_cddev = {
82 .dv_init = efipart_initcd,
83 .dv_strategy = efipart_strategy,
84 .dv_open = efipart_open,
85 .dv_close = efipart_close,
86 .dv_ioctl = efipart_ioctl,
87 .dv_print = efipart_printcd,
91 struct devsw efipart_hddev = {
94 .dv_init = efipart_inithd,
95 .dv_strategy = efipart_strategy,
96 .dv_open = efipart_open,
97 .dv_close = efipart_close,
98 .dv_ioctl = efipart_ioctl,
99 .dv_print = efipart_printhd,
103 static pdinfo_list_t fdinfo;
104 static pdinfo_list_t cdinfo;
105 static pdinfo_list_t hdinfo;
107 static EFI_HANDLE *efipart_handles = NULL;
108 static UINTN efipart_nhandles = 0;
111 efiblk_get_pdinfo_list(struct devsw *dev)
113 if (dev->dv_type == DEVT_DISK)
115 if (dev->dv_type == DEVT_CD)
117 if (dev->dv_type == DEVT_FD)
122 /* XXX this gets called way way too often, investigate */
124 efiblk_get_pdinfo(struct devdesc *dev)
129 pdi = efiblk_get_pdinfo_list(dev->d_dev);
133 STAILQ_FOREACH(pd, pdi, pd_link) {
134 if (pd->pd_unit == dev->d_unit)
141 efiblk_get_pdinfo_by_device_path(EFI_DEVICE_PATH *path)
145 h = efi_devpath_to_handle(path, efipart_handles, efipart_nhandles);
148 return (efiblk_get_pdinfo_by_handle(h));
152 same_handle(pdinfo_t *pd, EFI_HANDLE h)
155 return (pd->pd_handle == h || pd->pd_alias == h);
159 efiblk_get_pdinfo_by_handle(EFI_HANDLE h)
164 * Check hard disks, then cd, then floppy
166 STAILQ_FOREACH(dp, &hdinfo, pd_link) {
167 if (same_handle(dp, h))
169 STAILQ_FOREACH(pp, &dp->pd_part, pd_link) {
170 if (same_handle(pp, h))
174 STAILQ_FOREACH(dp, &cdinfo, pd_link) {
175 if (same_handle(dp, h))
178 STAILQ_FOREACH(dp, &fdinfo, pd_link) {
179 if (same_handle(dp, h))
186 efiblk_pdinfo_count(pdinfo_list_t *pdi)
191 STAILQ_FOREACH(pd, pdi, pd_link) {
198 efipart_inithandles(void)
204 if (efipart_nhandles != 0) {
205 free(efipart_handles);
206 efipart_handles = NULL;
207 efipart_nhandles = 0;
212 status = BS->LocateHandle(ByProtocol, &blkio_guid, 0, &sz, hin);
213 if (status == EFI_BUFFER_TOO_SMALL) {
215 status = BS->LocateHandle(ByProtocol, &blkio_guid, 0, &sz,
217 if (EFI_ERROR(status))
220 if (EFI_ERROR(status))
221 return (efi_status_to_errno(status));
223 efipart_handles = hin;
224 efipart_nhandles = sz / sizeof(*hin);
226 printf("%s: Got %d BLOCK IO MEDIA handle(s)\n", __func__,
232 static ACPI_HID_DEVICE_PATH *
233 efipart_floppy(EFI_DEVICE_PATH *node)
235 ACPI_HID_DEVICE_PATH *acpi;
237 if (DevicePathType(node) == ACPI_DEVICE_PATH &&
238 DevicePathSubType(node) == ACPI_DP) {
239 acpi = (ACPI_HID_DEVICE_PATH *) node;
240 if (acpi->HID == EISA_PNP_ID(PNP0604) ||
241 acpi->HID == EISA_PNP_ID(PNP0700) ||
242 acpi->HID == EISA_PNP_ID(PNP0701)) {
250 * Determine if the provided device path is hdd.
252 * There really is no simple fool proof way to classify the devices.
253 * Since we do build three lists of devices - floppy, cd and hdd, we
254 * will try to see if the device is floppy or cd, and list anything else
258 efipart_hdd(EFI_DEVICE_PATH *dp)
261 EFI_DEVICE_PATH *devpath, *node;
268 if ((node = efi_devpath_last_node(dp)) == NULL)
271 if (efipart_floppy(node) != NULL)
275 * Test every EFI BLOCK IO handle to make sure dp is not device path
278 for (i = 0; i < efipart_nhandles; i++) {
279 devpath = efi_lookup_devpath(efipart_handles[i]);
283 /* Only continue testing when dp is prefix in devpath. */
284 if (!efi_devpath_is_prefix(dp, devpath))
288 * The device path has to have last node describing the
289 * device, or we can not test the type.
291 if ((node = efi_devpath_last_node(devpath)) == NULL)
294 if (DevicePathType(node) == MEDIA_DEVICE_PATH &&
295 DevicePathSubType(node) == MEDIA_CDROM_DP) {
299 /* Make sure we do have the media. */
300 status = OpenProtocolByHandle(efipart_handles[i], &blkio_guid,
302 if (EFI_ERROR(status))
305 /* USB or SATA cd without the media. */
306 if (blkio->Media->RemovableMedia &&
307 !blkio->Media->MediaPresent) {
312 * We assume the block size 512 or greater power of 2.
313 * iPXE is known to insert stub BLOCK IO device with
316 if (blkio->Media->BlockSize < 512 ||
317 !powerof2(blkio->Media->BlockSize)) {
325 * Add or update entries with new handle data.
328 efipart_fdinfo_add(EFI_HANDLE handle, uint32_t uid, EFI_DEVICE_PATH *devpath)
332 fd = calloc(1, sizeof(pdinfo_t));
334 printf("Failed to register floppy %d, out of memory\n", uid);
337 STAILQ_INIT(&fd->pd_part);
340 fd->pd_handle = handle;
341 fd->pd_devpath = devpath;
342 fd->pd_parent = NULL;
343 fd->pd_devsw = &efipart_fddev;
344 STAILQ_INSERT_TAIL(&fdinfo, fd, pd_link);
349 efipart_updatefd(void)
351 EFI_DEVICE_PATH *devpath, *node;
352 ACPI_HID_DEVICE_PATH *acpi;
355 for (i = 0; i < efipart_nhandles; i++) {
356 devpath = efi_lookup_devpath(efipart_handles[i]);
360 if ((node = efi_devpath_last_node(devpath)) == NULL)
362 if ((acpi = efipart_floppy(node)) != NULL) {
363 efipart_fdinfo_add(efipart_handles[i], acpi->UID,
373 STAILQ_INIT(&fdinfo);
377 bcache_add_dev(efiblk_pdinfo_count(&fdinfo));
382 * Add or update entries with new handle data.
385 efipart_cdinfo_add(EFI_HANDLE handle, EFI_HANDLE alias,
386 EFI_DEVICE_PATH *devpath)
393 STAILQ_FOREACH(pd, &cdinfo, pd_link) {
394 if (efi_devpath_match(pd->pd_devpath, devpath) == true) {
395 pd->pd_handle = handle;
396 pd->pd_alias = alias;
402 cd = calloc(1, sizeof(pdinfo_t));
404 printf("Failed to add cd %d, out of memory\n", unit);
407 STAILQ_INIT(&cd->pd_part);
409 cd->pd_handle = handle;
411 cd->pd_alias = alias;
412 cd->pd_devpath = devpath;
413 cd->pd_parent = NULL;
414 cd->pd_devsw = &efipart_cddev;
415 STAILQ_INSERT_TAIL(&cdinfo, cd, pd_link);
420 efipart_updatecd(void)
423 EFI_DEVICE_PATH *devpath, *devpathcpy, *tmpdevpath, *node;
428 for (i = 0; i < efipart_nhandles; i++) {
429 devpath = efi_lookup_devpath(efipart_handles[i]);
433 if ((node = efi_devpath_last_node(devpath)) == NULL)
436 if (efipart_floppy(node) != NULL)
439 if (efipart_hdd(devpath))
442 status = OpenProtocolByHandle(efipart_handles[i], &blkio_guid,
444 if (EFI_ERROR(status))
447 * If we come across a logical partition of subtype CDROM
448 * it doesn't refer to the CD filesystem itself, but rather
449 * to any usable El Torito boot image on it. In this case
450 * we try to find the parent device and add that instead as
451 * that will be the CD filesystem.
453 if (DevicePathType(node) == MEDIA_DEVICE_PATH &&
454 DevicePathSubType(node) == MEDIA_CDROM_DP) {
455 devpathcpy = efi_devpath_trim(devpath);
456 if (devpathcpy == NULL)
458 tmpdevpath = devpathcpy;
459 status = BS->LocateDevicePath(&blkio_guid, &tmpdevpath,
462 if (EFI_ERROR(status))
464 devpath = efi_lookup_devpath(handle);
465 efipart_cdinfo_add(handle, efipart_handles[i],
470 if (DevicePathType(node) == MESSAGING_DEVICE_PATH &&
471 DevicePathSubType(node) == MSG_ATAPI_DP) {
472 efipart_cdinfo_add(efipart_handles[i], NULL,
477 /* USB or SATA cd without the media. */
478 if (blkio->Media->RemovableMedia &&
479 !blkio->Media->MediaPresent) {
480 efipart_cdinfo_add(efipart_handles[i], NULL,
490 STAILQ_INIT(&cdinfo);
494 bcache_add_dev(efiblk_pdinfo_count(&cdinfo));
499 efipart_hdinfo_add(EFI_HANDLE disk_handle, EFI_HANDLE part_handle)
501 EFI_DEVICE_PATH *disk_devpath, *part_devpath;
502 HARDDRIVE_DEVICE_PATH *node;
504 pdinfo_t *hd, *pd, *last;
506 disk_devpath = efi_lookup_devpath(disk_handle);
507 if (disk_devpath == NULL)
510 if (part_handle != NULL) {
511 part_devpath = efi_lookup_devpath(part_handle);
512 if (part_devpath == NULL)
514 node = (HARDDRIVE_DEVICE_PATH *)
515 efi_devpath_last_node(part_devpath);
517 return (ENOENT); /* This should not happen. */
523 pd = calloc(1, sizeof(pdinfo_t));
525 printf("Failed to add disk, out of memory\n");
528 STAILQ_INIT(&pd->pd_part);
530 STAILQ_FOREACH(hd, &hdinfo, pd_link) {
531 if (efi_devpath_match(hd->pd_devpath, disk_devpath) == true) {
532 if (part_devpath == NULL)
535 /* Add the partition. */
536 pd->pd_handle = part_handle;
537 pd->pd_unit = node->PartitionNumber;
538 pd->pd_devpath = part_devpath;
540 pd->pd_devsw = &efipart_hddev;
541 STAILQ_INSERT_TAIL(&hd->pd_part, pd, pd_link);
546 last = STAILQ_LAST(&hdinfo, pdinfo, pd_link);
548 unit = last->pd_unit + 1;
554 hd->pd_handle = disk_handle;
556 hd->pd_devpath = disk_devpath;
557 hd->pd_parent = NULL;
558 hd->pd_devsw = &efipart_hddev;
559 STAILQ_INSERT_TAIL(&hdinfo, hd, pd_link);
561 if (part_devpath == NULL)
564 pd = calloc(1, sizeof(pdinfo_t));
566 printf("Failed to add partition, out of memory\n");
569 STAILQ_INIT(&pd->pd_part);
571 /* Add the partition. */
572 pd->pd_handle = part_handle;
573 pd->pd_unit = node->PartitionNumber;
574 pd->pd_devpath = part_devpath;
576 pd->pd_devsw = &efipart_hddev;
577 STAILQ_INSERT_TAIL(&hd->pd_part, pd, pd_link);
583 * The MEDIA_FILEPATH_DP has device name.
584 * From U-Boot sources it looks like names are in the form
585 * of typeN:M, where type is interface type, N is disk id
586 * and M is partition id.
589 efipart_hdinfo_add_filepath(EFI_HANDLE disk_handle)
591 EFI_DEVICE_PATH *devpath;
592 FILEPATH_DEVICE_PATH *node;
597 /* First collect and verify all the data */
598 if ((devpath = efi_lookup_devpath(disk_handle)) == NULL)
600 node = (FILEPATH_DEVICE_PATH *)efi_devpath_last_node(devpath);
602 return (ENOENT); /* This should not happen. */
604 pd = calloc(1, sizeof(pdinfo_t));
606 printf("Failed to add disk, out of memory\n");
609 STAILQ_INIT(&pd->pd_part);
610 last = STAILQ_LAST(&hdinfo, pdinfo, pd_link);
612 unit = last->pd_unit + 1;
616 /* FILEPATH_DEVICE_PATH has 0 terminated string */
617 len = ucs2len(node->PathName);
618 if ((pathname = malloc(len + 1)) == NULL) {
619 printf("Failed to add disk, out of memory\n");
623 cpy16to8(node->PathName, pathname, len + 1);
624 p = strchr(pathname, ':');
627 * Assume we are receiving handles in order, first disk handle,
628 * then partitions for this disk. If this assumption proves
629 * false, this code would need update.
631 if (p == NULL) { /* no colon, add the disk */
632 pd->pd_handle = disk_handle;
634 pd->pd_devpath = devpath;
635 pd->pd_parent = NULL;
636 pd->pd_devsw = &efipart_hddev;
637 STAILQ_INSERT_TAIL(&hdinfo, pd, pd_link);
641 p++; /* skip the colon */
643 unit = (int)strtol(p, NULL, 0);
645 printf("Bad unit number for partition \"%s\"\n", pathname);
652 * We should have disk registered, if not, we are receiving
653 * handles out of order, and this code should be reworked
654 * to create "blank" disk for partition, and to find the
655 * disk based on PathName compares.
658 printf("BUG: No disk for partition \"%s\"\n", pathname);
663 /* Add the partition. */
664 pd->pd_handle = disk_handle;
666 pd->pd_devpath = devpath;
667 pd->pd_parent = last;
668 pd->pd_devsw = &efipart_hddev;
669 STAILQ_INSERT_TAIL(&last->pd_part, pd, pd_link);
675 efipart_updatehd(void)
678 EFI_DEVICE_PATH *devpath, *devpathcpy, *tmpdevpath, *node;
683 for (i = 0; i < efipart_nhandles; i++) {
684 devpath = efi_lookup_devpath(efipart_handles[i]);
688 if ((node = efi_devpath_last_node(devpath)) == NULL)
691 if (!efipart_hdd(devpath))
694 status = OpenProtocolByHandle(efipart_handles[i], &blkio_guid,
696 if (EFI_ERROR(status))
699 if (DevicePathType(node) == MEDIA_DEVICE_PATH &&
700 DevicePathSubType(node) == MEDIA_FILEPATH_DP) {
701 efipart_hdinfo_add_filepath(efipart_handles[i]);
705 if (DevicePathType(node) == MEDIA_DEVICE_PATH &&
706 DevicePathSubType(node) == MEDIA_HARDDRIVE_DP) {
707 devpathcpy = efi_devpath_trim(devpath);
708 if (devpathcpy == NULL)
710 tmpdevpath = devpathcpy;
711 status = BS->LocateDevicePath(&blkio_guid, &tmpdevpath,
714 if (EFI_ERROR(status))
717 * We do not support nested partitions.
719 devpathcpy = efi_lookup_devpath(handle);
720 if (devpathcpy == NULL)
722 if ((node = efi_devpath_last_node(devpathcpy)) == NULL)
725 if (DevicePathType(node) == MEDIA_DEVICE_PATH &&
726 DevicePathSubType(node) == MEDIA_HARDDRIVE_DP)
729 efipart_hdinfo_add(handle, efipart_handles[i]);
733 efipart_hdinfo_add(efipart_handles[i], NULL);
741 STAILQ_INIT(&hdinfo);
745 bcache_add_dev(efiblk_pdinfo_count(&hdinfo));
750 efipart_print_common(struct devsw *dev, pdinfo_list_t *pdlist, int verbose)
758 struct disk_devdesc pd_dev;
761 if (STAILQ_EMPTY(pdlist))
764 printf("%s devices:", dev->dv_name);
765 if ((ret = pager_output("\n")) != 0)
768 STAILQ_FOREACH(pd, pdlist, pd_link) {
770 if (verbose) { /* Output the device path. */
771 text = efi_devpath_name(efi_lookup_devpath(h));
774 efi_free_devpath_name(text);
775 if ((ret = pager_output("\n")) != 0)
779 snprintf(line, sizeof(line),
780 " %s%d", dev->dv_name, pd->pd_unit);
782 status = OpenProtocolByHandle(h, &blkio_guid, (void **)&blkio);
783 if (!EFI_ERROR(status)) {
785 blkio->Media->LastBlock == 0? 0:
786 (unsigned long long) (blkio->Media->LastBlock + 1));
787 if (blkio->Media->LastBlock != 0) {
788 printf(" X %u", blkio->Media->BlockSize);
791 if (blkio->Media->MediaPresent) {
792 if (blkio->Media->RemovableMedia)
793 printf(" (removable)");
795 printf(" (no media)");
797 if ((ret = pager_output("\n")) != 0)
799 if (!blkio->Media->MediaPresent)
802 pd->pd_blkio = blkio;
803 pd_dev.dd.d_dev = dev;
804 pd_dev.dd.d_unit = pd->pd_unit;
805 pd_dev.d_slice = D_SLICENONE;
806 pd_dev.d_partition = D_PARTNONE;
807 ret = disk_open(&pd_dev, blkio->Media->BlockSize *
808 (blkio->Media->LastBlock + 1),
809 blkio->Media->BlockSize);
811 ret = disk_print(&pd_dev, line, verbose);
816 /* Do not fail from disk_open() */
820 if ((ret = pager_output("\n")) != 0)
828 efipart_printfd(int verbose)
830 return (efipart_print_common(&efipart_fddev, &fdinfo, verbose));
834 efipart_printcd(int verbose)
836 return (efipart_print_common(&efipart_cddev, &cdinfo, verbose));
840 efipart_printhd(int verbose)
842 return (efipart_print_common(&efipart_hddev, &hdinfo, verbose));
846 efipart_open(struct open_file *f, ...)
849 struct disk_devdesc *dev;
855 dev = va_arg(args, struct disk_devdesc*);
860 pd = efiblk_get_pdinfo((struct devdesc *)dev);
864 if (pd->pd_blkio == NULL) {
865 status = OpenProtocolByHandle(pd->pd_handle, &blkio_guid,
866 (void **)&pd->pd_blkio);
867 if (EFI_ERROR(status))
868 return (efi_status_to_errno(status));
871 blkio = pd->pd_blkio;
872 if (!blkio->Media->MediaPresent)
876 if (pd->pd_bcache == NULL)
877 pd->pd_bcache = bcache_allocate();
879 if (dev->dd.d_dev->dv_type == DEVT_DISK) {
883 blkio->Media->BlockSize * (blkio->Media->LastBlock + 1),
884 blkio->Media->BlockSize);
887 if (pd->pd_open == 0) {
889 bcache_free(pd->pd_bcache);
890 pd->pd_bcache = NULL;
899 efipart_close(struct open_file *f)
901 struct disk_devdesc *dev;
904 dev = (struct disk_devdesc *)(f->f_devdata);
908 pd = efiblk_get_pdinfo((struct devdesc *)dev);
913 if (pd->pd_open == 0) {
915 bcache_free(pd->pd_bcache);
916 pd->pd_bcache = NULL;
918 if (dev->dd.d_dev->dv_type == DEVT_DISK)
919 return (disk_close(dev));
924 efipart_ioctl(struct open_file *f, u_long cmd, void *data)
926 struct disk_devdesc *dev;
930 dev = (struct disk_devdesc *)(f->f_devdata);
934 pd = efiblk_get_pdinfo((struct devdesc *)dev);
938 if (dev->dd.d_dev->dv_type == DEVT_DISK) {
939 rc = disk_ioctl(dev, cmd, data);
945 case DIOCGSECTORSIZE:
946 *(u_int *)data = pd->pd_blkio->Media->BlockSize;
949 *(uint64_t *)data = pd->pd_blkio->Media->BlockSize *
950 (pd->pd_blkio->Media->LastBlock + 1);
960 * efipart_readwrite()
961 * Internal equivalent of efipart_strategy(), which operates on the
962 * media-native block size. This function expects all I/O requests
963 * to be within the media size and returns an error if such is not
967 efipart_readwrite(EFI_BLOCK_IO *blkio, int rw, daddr_t blk, daddr_t nblks,
974 if (blk < 0 || blk > blkio->Media->LastBlock)
976 if ((blk + nblks - 1) > blkio->Media->LastBlock)
979 switch (rw & F_MASK) {
981 status = blkio->ReadBlocks(blkio, blkio->Media->MediaId, blk,
982 nblks * blkio->Media->BlockSize, buf);
985 if (blkio->Media->ReadOnly)
987 status = blkio->WriteBlocks(blkio, blkio->Media->MediaId, blk,
988 nblks * blkio->Media->BlockSize, buf);
994 if (EFI_ERROR(status)) {
995 printf("%s: rw=%d, blk=%ju size=%ju status=%lu\n", __func__, rw,
996 blk, nblks, EFI_ERROR_CODE(status));
998 return (efi_status_to_errno(status));
1002 efipart_strategy(void *devdata, int rw, daddr_t blk, size_t size,
1003 char *buf, size_t *rsize)
1005 struct bcache_devdata bcd;
1006 struct disk_devdesc *dev;
1009 dev = (struct disk_devdesc *)devdata;
1013 pd = efiblk_get_pdinfo((struct devdesc *)dev);
1017 if (pd->pd_blkio->Media->RemovableMedia &&
1018 !pd->pd_blkio->Media->MediaPresent)
1021 bcd.dv_strategy = efipart_realstrategy;
1022 bcd.dv_devdata = devdata;
1023 bcd.dv_cache = pd->pd_bcache;
1025 if (dev->dd.d_dev->dv_type == DEVT_DISK) {
1028 offset = dev->d_offset * pd->pd_blkio->Media->BlockSize;
1030 return (bcache_strategy(&bcd, rw, blk + offset,
1033 return (bcache_strategy(&bcd, rw, blk, size, buf, rsize));
1037 efipart_realstrategy(void *devdata, int rw, daddr_t blk, size_t size,
1038 char *buf, size_t *rsize)
1040 struct disk_devdesc *dev = (struct disk_devdesc *)devdata;
1042 EFI_BLOCK_IO *blkio;
1043 uint64_t off, disk_blocks, d_offset = 0;
1045 size_t blkoff, blksz;
1047 size_t diskend, readstart;
1049 if (dev == NULL || blk < 0)
1052 pd = efiblk_get_pdinfo((struct devdesc *)dev);
1056 blkio = pd->pd_blkio;
1060 if (size == 0 || (size % 512) != 0)
1065 * Get disk blocks, this value is either for whole disk or for
1069 if (dev->dd.d_dev->dv_type == DEVT_DISK) {
1070 if (disk_ioctl(dev, DIOCGMEDIASIZE, &disk_blocks) == 0) {
1071 /* DIOCGMEDIASIZE does return bytes. */
1072 disk_blocks /= blkio->Media->BlockSize;
1074 d_offset = dev->d_offset;
1076 if (disk_blocks == 0)
1077 disk_blocks = blkio->Media->LastBlock + 1 - d_offset;
1079 /* make sure we don't read past disk end */
1080 if ((off + size) / blkio->Media->BlockSize > d_offset + disk_blocks) {
1081 diskend = d_offset + disk_blocks;
1082 readstart = off / blkio->Media->BlockSize;
1084 if (diskend <= readstart) {
1090 size = diskend - readstart;
1091 size = size * blkio->Media->BlockSize;
1097 if ((size % blkio->Media->BlockSize == 0) &&
1098 (off % blkio->Media->BlockSize == 0))
1099 return (efipart_readwrite(blkio, rw,
1100 off / blkio->Media->BlockSize,
1101 size / blkio->Media->BlockSize, buf));
1104 * The block size of the media is not a multiple of I/O.
1106 blkbuf = malloc(blkio->Media->BlockSize);
1111 blk = off / blkio->Media->BlockSize;
1112 blkoff = off % blkio->Media->BlockSize;
1113 blksz = blkio->Media->BlockSize - blkoff;
1115 error = efipart_readwrite(blkio, rw, blk, 1, blkbuf);
1120 bcopy(blkbuf + blkoff, buf, blksz);
1125 blksz = blkio->Media->BlockSize;