2N/A/* nand.c - NAND flash disk access. */
2N/A/*
2N/A * GRUB -- GRand Unified Bootloader
2N/A * Copyright (C) 2008,2009 Free Software Foundation, Inc.
2N/A *
2N/A * GRUB is free software: you can redistribute it and/or modify
2N/A * it under the terms of the GNU General Public License as published by
2N/A * the Free Software Foundation, either version 3 of the License, or
2N/A * (at your option) any later version.
2N/A *
2N/A * GRUB is distributed in the hope that it will be useful,
2N/A * but WITHOUT ANY WARRANTY; without even the implied warranty of
2N/A * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
2N/A * GNU General Public License for more details.
2N/A *
2N/A * You should have received a copy of the GNU General Public License
2N/A * along with GRUB. If not, see <http://www.gnu.org/licenses/>.
2N/A */
2N/A
2N/A#include <grub/misc.h>
2N/A#include <grub/disk.h>
2N/A#include <grub/mm.h>
2N/A#include <grub/dl.h>
2N/A#include <grub/ieee1275/ieee1275.h>
2N/A
2N/AGRUB_MOD_LICENSE ("GPLv3+");
2N/A
2N/Astruct grub_nand_data
2N/A{
2N/A grub_ieee1275_ihandle_t handle;
2N/A grub_uint32_t block_size;
2N/A};
2N/A
2N/Astatic int
2N/Agrub_nand_iterate (int (*hook) (const char *name),
2N/A grub_disk_pull_t pull)
2N/A{
2N/A auto int dev_iterate (struct grub_ieee1275_devalias *alias);
2N/A int dev_iterate (struct grub_ieee1275_devalias *alias)
2N/A {
2N/A if (! grub_strcmp (alias->name, "nand"))
2N/A {
2N/A hook (alias->name);
2N/A return 1;
2N/A }
2N/A
2N/A return 0;
2N/A }
2N/A
2N/A if (pull != GRUB_DISK_PULL_NONE)
2N/A return 0;
2N/A
2N/A return grub_devalias_iterate (dev_iterate);
2N/A}
2N/A
2N/Astatic grub_err_t
2N/Agrub_nand_read (grub_disk_t disk, grub_disk_addr_t sector,
2N/A grub_size_t size, char *buf);
2N/A
2N/Astatic grub_err_t
2N/Agrub_nand_open (const char *name, grub_disk_t disk)
2N/A{
2N/A grub_ieee1275_ihandle_t dev_ihandle = 0;
2N/A struct grub_nand_data *data = 0;
2N/A struct size_args
2N/A {
2N/A struct grub_ieee1275_common_hdr common;
2N/A grub_ieee1275_cell_t method;
2N/A grub_ieee1275_cell_t ihandle;
2N/A grub_ieee1275_cell_t result;
2N/A grub_ieee1275_cell_t size1;
2N/A grub_ieee1275_cell_t size2;
2N/A } args;
2N/A
2N/A if (! grub_strstr (name, "nand"))
2N/A return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "not a NAND device");
2N/A
2N/A data = grub_malloc (sizeof (*data));
2N/A if (! data)
2N/A goto fail;
2N/A
2N/A grub_ieee1275_open (name, &dev_ihandle);
2N/A if (! dev_ihandle)
2N/A {
2N/A grub_error (GRUB_ERR_UNKNOWN_DEVICE, "can't open device");
2N/A goto fail;
2N/A }
2N/A
2N/A data->handle = dev_ihandle;
2N/A
2N/A INIT_IEEE1275_COMMON (&args.common, "call-method", 2, 2);
2N/A args.method = (grub_ieee1275_cell_t) "block-size";
2N/A args.ihandle = dev_ihandle;
2N/A args.result = 1;
2N/A
2N/A if ((IEEE1275_CALL_ENTRY_FN (&args) == -1) || (args.result))
2N/A {
2N/A grub_error (GRUB_ERR_UNKNOWN_DEVICE, "can't get block size");
2N/A goto fail;
2N/A }
2N/A
2N/A data->block_size = (args.size1 >> GRUB_DISK_SECTOR_BITS);
2N/A
2N/A INIT_IEEE1275_COMMON (&args.common, "call-method", 2, 3);
2N/A args.method = (grub_ieee1275_cell_t) "size";
2N/A args.ihandle = dev_ihandle;
2N/A args.result = 1;
2N/A
2N/A if ((IEEE1275_CALL_ENTRY_FN (&args) == -1) || (args.result))
2N/A {
2N/A grub_error (GRUB_ERR_UNKNOWN_DEVICE, "can't get disk size");
2N/A goto fail;
2N/A }
2N/A
2N/A disk->total_sectors = args.size1;
2N/A disk->total_sectors <<= 32;
2N/A disk->total_sectors += args.size2;
2N/A disk->total_sectors >>= GRUB_DISK_SECTOR_BITS;
2N/A
2N/A disk->id = dev_ihandle;
2N/A
2N/A disk->data = data;
2N/A
2N/A return 0;
2N/A
2N/Afail:
2N/A if (dev_ihandle)
2N/A grub_ieee1275_close (dev_ihandle);
2N/A grub_free (data);
2N/A return grub_errno;
2N/A}
2N/A
2N/Astatic void
2N/Agrub_nand_close (grub_disk_t disk)
2N/A{
2N/A grub_ieee1275_close (((struct grub_nand_data *) disk->data)->handle);
2N/A grub_free (disk->data);
2N/A}
2N/A
2N/Astatic grub_err_t
2N/Agrub_nand_read (grub_disk_t disk, grub_disk_addr_t sector,
2N/A grub_size_t size, char *buf)
2N/A{
2N/A struct grub_nand_data *data = disk->data;
2N/A grub_size_t bsize, ofs;
2N/A
2N/A struct read_args
2N/A {
2N/A struct grub_ieee1275_common_hdr common;
2N/A grub_ieee1275_cell_t method;
2N/A grub_ieee1275_cell_t ihandle;
2N/A grub_ieee1275_cell_t ofs;
2N/A grub_ieee1275_cell_t page;
2N/A grub_ieee1275_cell_t len;
2N/A grub_ieee1275_cell_t buf;
2N/A grub_ieee1275_cell_t result;
2N/A } args;
2N/A
2N/A INIT_IEEE1275_COMMON (&args.common, "call-method", 6, 1);
2N/A args.method = (grub_ieee1275_cell_t) "pio-read";
2N/A args.ihandle = data->handle;
2N/A args.buf = (grub_ieee1275_cell_t) buf;
2N/A args.page = (grub_ieee1275_cell_t) ((grub_size_t) sector / data->block_size);
2N/A
2N/A ofs = ((grub_size_t) sector % data->block_size) << GRUB_DISK_SECTOR_BITS;
2N/A size <<= GRUB_DISK_SECTOR_BITS;
2N/A bsize = (data->block_size << GRUB_DISK_SECTOR_BITS);
2N/A
2N/A do
2N/A {
2N/A grub_size_t len;
2N/A
2N/A len = (ofs + size > bsize) ? (bsize - ofs) : size;
2N/A
2N/A args.len = (grub_ieee1275_cell_t) len;
2N/A args.ofs = (grub_ieee1275_cell_t) ofs;
2N/A args.result = 1;
2N/A
2N/A if ((IEEE1275_CALL_ENTRY_FN (&args) == -1) || (args.result))
2N/A return grub_error (GRUB_ERR_READ_ERROR, "read error");
2N/A
2N/A ofs = 0;
2N/A size -= len;
2N/A args.buf += len;
2N/A args.page++;
2N/A } while (size);
2N/A
2N/A return GRUB_ERR_NONE;
2N/A}
2N/A
2N/Astatic grub_err_t
2N/Agrub_nand_write (grub_disk_t disk __attribute ((unused)),
2N/A grub_disk_addr_t sector __attribute ((unused)),
2N/A grub_size_t size __attribute ((unused)),
2N/A const char *buf __attribute ((unused)))
2N/A{
2N/A return GRUB_ERR_NOT_IMPLEMENTED_YET;
2N/A}
2N/A
2N/Astatic struct grub_disk_dev grub_nand_dev =
2N/A {
2N/A .name = "nand",
2N/A .id = GRUB_DISK_DEVICE_NAND_ID,
2N/A .iterate = grub_nand_iterate,
2N/A .open = grub_nand_open,
2N/A .close = grub_nand_close,
2N/A .read = grub_nand_read,
2N/A .write = grub_nand_write,
2N/A .next = 0
2N/A };
2N/A
2N/AGRUB_MOD_INIT(nand)
2N/A{
2N/A grub_disk_dev_register (&grub_nand_dev);
2N/A}
2N/A
2N/AGRUB_MOD_FINI(nand)
2N/A{
2N/A grub_disk_dev_unregister (&grub_nand_dev);
2N/A}