vaseboot/VasEBoot-core/disk/uboot/ubootdisk.c

/* ubootdisk.c - disk subsystem support for U-Boot platforms */
/*
 *  VAS_EBOOT  --  GRand Unified Bootloader
 *  Copyright (C) 2013  Free Software Foundation, Inc.
 *
 *  VAS_EBOOT is free software: you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation, either version 3 of the License, or
 *  (at your option) any later version.
 *
 *  VAS_EBOOT is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with VAS_EBOOT.  If not, see <http://www.gnu.org/licenses/>.
 */

#include <VasEBoot/disk.h>
#include <VasEBoot/err.h>
#include <VasEBoot/misc.h>
#include <VasEBoot/mm.h>
#include <VasEBoot/partition.h>
#include <VasEBoot/term.h>
#include <VasEBoot/types.h>
#include <VasEBoot/uboot/disk.h>
#include <VasEBoot/uboot/uboot.h>
#include <VasEBoot/uboot/api_public.h>

static struct ubootdisk_data *hd_devices;
static int hd_num;
static int hd_max;

/*
 * VasEBoot_ubootdisk_register():
 *   Called for each disk device enumerated as part of U-Boot initialization
 *   code.
 */
VasEBoot_err_t
VasEBoot_ubootdisk_register (struct device_info *newdev)
{
  struct ubootdisk_data *d;

#define STOR_TYPE(x) ((x) & 0x0ff0)
  switch (STOR_TYPE (newdev->type))
    {
    case DT_STOR_IDE:
    case DT_STOR_SATA:
    case DT_STOR_SCSI:
    case DT_STOR_MMC:
    case DT_STOR_USB:
      /* hd */
      if (hd_num == hd_max)
	{
	  int new_num;
	  new_num = (hd_max ? hd_max * 2 : 1);
	  d = VasEBoot_realloc(hd_devices,
			   sizeof (struct ubootdisk_data) * new_num);
	  if (!d)
	    return VasEBoot_errno;
	  hd_devices = d;
	  hd_max = new_num;
	}

      d = &hd_devices[hd_num];
      hd_num++;
      break;
    default:
      return VAS_EBOOT_ERR_BAD_DEVICE;
      break;
    }

  d->dev = newdev;
  d->cookie = newdev->cookie;
  d->opencount = 0;

  return 0;
}

/*
 * uboot_disk_iterate():
 *   Iterator over enumerated disk devices.
 */
static int
uboot_disk_iterate (VasEBoot_disk_dev_iterate_hook_t hook, void *hook_data,
		    VasEBoot_disk_pull_t pull)
{
  char buf[16];
  int count;

  switch (pull)
    {
    case VAS_EBOOT_DISK_PULL_NONE:
      /* "hd" - built-in mass-storage */
      for (count = 0 ; count < hd_num; count++)
	{
	  VasEBoot_snprintf (buf, sizeof (buf) - 1, "hd%d", count);
	  VasEBoot_dprintf ("ubootdisk", "iterating %s\n", buf);
	  if (hook (buf, hook_data))
	    return 1;
	}
      break;
    default:
      return 0;
    }

  return 0;
}

/* Helper function for uboot_disk_open. */
static struct ubootdisk_data *
get_hd_device (int num)
{
  if (num < hd_num)
    return &hd_devices[num];

  return NULL;
}

/*
 * uboot_disk_open():
 *   Opens a disk device already enumerated.
 */
static VasEBoot_err_t
uboot_disk_open (const char *name, struct VasEBoot_disk *disk)
{
  struct ubootdisk_data *d;
  struct device_info *devinfo;
  int num;
  int retval;

  VasEBoot_dprintf ("ubootdisk", "Opening '%s'\n", name);

  num = VasEBoot_strtoul (name + 2, 0, 10);
  if (VasEBoot_errno != VAS_EBOOT_ERR_NONE)
    {
      VasEBoot_dprintf ("ubootdisk", "Opening '%s' failed, invalid number\n",
		    name);
      goto fail;
    }

  if (name[1] != 'd')
    {
      VasEBoot_dprintf ("ubootdisk", "Opening '%s' failed, invalid name\n", name);
      goto fail;
    }

  switch (name[0])
    {
    case 'h':
      d = get_hd_device (num);
      break;
    default:
      goto fail;
    }

  if (!d)
    goto fail;

  /*
   * Subsystems may call open on the same device recursively - but U-Boot
   * does not deal with this. So simply keep track of number of calls and
   * return success if already open.
   */
  if (d->opencount > 0)
    {
      VasEBoot_dprintf ("ubootdisk", "(%s) already open\n", disk->name);
      d->opencount++;
      retval = 0;
    }
  else
    {
      retval = VasEBoot_uboot_dev_open (d->dev);
      if (retval != 0)
	goto fail;
      d->opencount = 1;
    }

  VasEBoot_dprintf ("ubootdisk", "cookie: 0x%08x\n", (VasEBoot_addr_t) d->cookie);
  disk->id = (VasEBoot_addr_t) d->cookie;

  devinfo = d->dev;

  d->block_size = devinfo->di_stor.block_size;
  if (d->block_size == 0)
    return VasEBoot_error (VAS_EBOOT_ERR_IO, "no block size");

  disk->log_sector_size = VasEBoot_log2ull (d->block_size);

  VasEBoot_dprintf ("ubootdisk", "(%s) blocksize=%d, log_sector_size=%d\n",
		disk->name, d->block_size, disk->log_sector_size);

  if (devinfo->di_stor.block_count)
    disk->total_sectors = devinfo->di_stor.block_count;
  else
    disk->total_sectors = VAS_EBOOT_DISK_SIZE_UNKNOWN;

  disk->data = d;

  return VAS_EBOOT_ERR_NONE;

fail:
  return VasEBoot_error (VAS_EBOOT_ERR_UNKNOWN_DEVICE, "no such device");
}

static void
uboot_disk_close (struct VasEBoot_disk *disk)
{
  struct ubootdisk_data *d;
  int retval;

  d = disk->data;

  /*
   * In mirror of open function, keep track of number of calls to close and
   * send on to U-Boot only when opencount would decrease to 0.
   */
  if (d->opencount > 1)
    {
      VasEBoot_dprintf ("ubootdisk", "Closed (%s)\n", disk->name);

      d->opencount--;
    }
  else if (d->opencount == 1)
    {
      retval = VasEBoot_uboot_dev_close (d->dev);
      d->opencount--;
      VasEBoot_dprintf ("ubootdisk", "closed %s (%d)\n", disk->name, retval);
    }
  else
    {
      VasEBoot_dprintf ("ubootdisk", "device %s not open!\n", disk->name);
    }
}

/*
 * uboot_disk_read():
 *   Called from within disk subsystem to read a sequence of blocks into the
 *   disk cache. Maps directly on top of U-Boot API, only wrap in some error
 *   handling.
 */
static VasEBoot_err_t
uboot_disk_read (struct VasEBoot_disk *disk,
		 VasEBoot_disk_addr_t offset, VasEBoot_size_t numblocks, char *buf)
{
  struct ubootdisk_data *d;
  VasEBoot_size_t real_size;
  int retval;

  d = disk->data;

  retval = VasEBoot_uboot_dev_read (d->dev, buf, numblocks, offset, &real_size);
  VasEBoot_dprintf ("ubootdisk",
		"retval=%d, numblocks=%d, real_size=%llu, sector=%llu\n",
		retval, numblocks, (VasEBoot_uint64_t) real_size,
		(VasEBoot_uint64_t) offset);
  if (retval != 0)
    return VasEBoot_error (VAS_EBOOT_ERR_IO, "U-Boot disk read error");

  return VAS_EBOOT_ERR_NONE;
}

static VasEBoot_err_t
uboot_disk_write (struct VasEBoot_disk *disk,
		  VasEBoot_disk_addr_t offset, VasEBoot_size_t numblocks, const char *buf)
{
  struct ubootdisk_data *d;
  int retval;

  d = disk->data;

  retval = VasEBoot_uboot_dev_write (d->dev, buf, numblocks, offset);
  VasEBoot_dprintf ("ubootdisk",
		"retval=%d, numblocks=%d, sector=%llu\n",
		retval, numblocks, (VasEBoot_uint64_t) offset);

  if (retval != 0)
    return VasEBoot_error (VAS_EBOOT_ERR_IO, "U-Boot disk write error");

  return VAS_EBOOT_ERR_NONE;
}

static struct VasEBoot_disk_dev VasEBoot_ubootdisk_dev = {
  .name = "ubootdisk",
  .id = VAS_EBOOT_DISK_DEVICE_UBOOTDISK_ID,
  .disk_iterate = uboot_disk_iterate,
  .disk_open = uboot_disk_open,
  .disk_close = uboot_disk_close,
  .disk_read = uboot_disk_read,
  .disk_write = uboot_disk_write,
  .next = 0
};

void
VasEBoot_ubootdisk_init (void)
{
  VasEBoot_disk_dev_register (&VasEBoot_ubootdisk_dev);
}

void
VasEBoot_ubootdisk_fini (void)
{
  VasEBoot_disk_dev_unregister (&VasEBoot_ubootdisk_dev);
}