summaryrefslogtreecommitdiffstats
path: root/sys/geom/geom_flashmap.c
diff options
context:
space:
mode:
authorgber <gber@FreeBSD.org>2012-05-22 08:33:14 +0000
committergber <gber@FreeBSD.org>2012-05-22 08:33:14 +0000
commita0e3acd0eedbb9da5995797acecd3217cf85dd0c (patch)
tree7f9303856f7047926cd49ff544aefb9b9b823229 /sys/geom/geom_flashmap.c
parentc7e30562ca4666f65f2c70644a4d5424759fd2f6 (diff)
downloadFreeBSD-src-a0e3acd0eedbb9da5995797acecd3217cf85dd0c.zip
FreeBSD-src-a0e3acd0eedbb9da5995797acecd3217cf85dd0c.tar.gz
Add a new geom class which allows to divide NAND Flash chip
into partitions. Partitions are created based on data in dts file which are extracted and interpreted by slicer. Obtained from: Semihalf Supported by: FreeBSD Foundation, Juniper Networks
Diffstat (limited to 'sys/geom/geom_flashmap.c')
-rw-r--r--sys/geom/geom_flashmap.c255
1 files changed, 255 insertions, 0 deletions
diff --git a/sys/geom/geom_flashmap.c b/sys/geom/geom_flashmap.c
new file mode 100644
index 0000000..c657123
--- /dev/null
+++ b/sys/geom/geom_flashmap.c
@@ -0,0 +1,255 @@
+/*-
+ * Copyright (c) 2012 Semihalf
+ * Copyright (c) 2009 Jakub Klama <jakub.klama@uj.edu.pl>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/endian.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/fcntl.h>
+#include <sys/malloc.h>
+#include <sys/bio.h>
+#include <sys/bus.h>
+#include <sys/lock.h>
+#include <sys/mutex.h>
+#include <sys/slicer.h>
+
+#include <geom/geom.h>
+#include <geom/geom_slice.h>
+#include <geom/geom_disk.h>
+#include <dev/nand/nand_dev.h>
+
+#define FLASHMAP_CLASS_NAME "Flashmap"
+
+struct g_flashmap_slice {
+ off_t sl_start;
+ off_t sl_end;
+ const char *sl_name;
+
+ STAILQ_ENTRY(g_flashmap_slice) sl_link;
+};
+
+STAILQ_HEAD(g_flashmap_head, g_flashmap_slice);
+
+static void g_flashmap_print(struct g_flashmap_slice *);
+static int g_flashmap_modify(struct g_geom *, const char *,
+ int, struct g_flashmap_head *);
+static int g_flashmap_start(struct bio *);
+static int g_flashmap_ioctl(struct g_provider *, u_long, void *,
+ int, struct thread *);
+static void g_flashmap_dumpconf(struct sbuf *, const char *,
+ struct g_geom *, struct g_consumer *, struct g_provider *);
+static struct g_geom *g_flashmap_taste(struct g_class *,
+ struct g_provider *, int);
+static void g_flashmap_config(struct gctl_req *, struct g_class *,
+ const char *);
+static int g_flashmap_load(device_t, struct g_flashmap_head *);
+
+MALLOC_DECLARE(M_FLASHMAP);
+MALLOC_DEFINE(M_FLASHMAP, "geom_flashmap", "GEOM flash memory slicer class");
+
+static void
+g_flashmap_print(struct g_flashmap_slice *slice)
+{
+
+ printf("%08llx-%08llx: %s (%lluKB)\n", slice->sl_start, slice->sl_end,
+ slice->sl_name, (slice->sl_end - slice->sl_start) / 1024);
+}
+
+static int
+g_flashmap_modify(struct g_geom *gp, const char *devname, int secsize,
+ struct g_flashmap_head *slices)
+{
+ struct g_flashmap_slice *slice;
+ int i, error;
+
+ g_topology_assert();
+
+ i = 0;
+ STAILQ_FOREACH(slice, slices, sl_link) {
+ if (bootverbose) {
+ printf("%s: slice ", devname);
+ g_flashmap_print(slice);
+ }
+
+ error = g_slice_config(gp, i++, G_SLICE_CONFIG_CHECK,
+ slice->sl_start,
+ slice->sl_end - slice->sl_start + 1,
+ secsize, "%ss.%s", gp->name, slice->sl_name);
+
+ if (error)
+ return (error);
+ }
+
+ i = 0;
+ STAILQ_FOREACH(slice, slices, sl_link) {
+ error = g_slice_config(gp, i++, G_SLICE_CONFIG_SET,
+ slice->sl_start,
+ slice->sl_end - slice->sl_start + 1,
+ secsize, "%ss.%s", gp->name, slice->sl_name);
+
+ if (error)
+ return (error);
+ }
+
+ return (0);
+}
+
+static int
+g_flashmap_start(struct bio *bp)
+{
+
+ return (0);
+}
+
+static void
+g_flashmap_dumpconf(struct sbuf *sb, const char *indent, struct g_geom *gp,
+ struct g_consumer *cp __unused, struct g_provider *pp)
+{
+ struct g_slicer *gsp;
+
+ gsp = gp->softc;
+ g_slice_dumpconf(sb, indent, gp, cp, pp);
+}
+
+static int
+g_flashmap_ioctl(struct g_provider *pp, u_long cmd, void *data, int fflag,
+ struct thread *td)
+{
+ struct g_consumer *cp;
+ struct g_geom *gp;
+
+ if (cmd != NAND_IO_GET_CHIP_PARAM)
+ return (ENOIOCTL);
+
+ cp = LIST_FIRST(&pp->geom->consumer);
+ if (cp == NULL)
+ return (ENOIOCTL);
+ gp = cp->provider->geom;
+ if (gp->ioctl == NULL)
+ return (ENOIOCTL);
+
+ return (gp->ioctl(cp->provider, cmd, data, fflag, td));
+}
+
+
+static struct g_geom *
+g_flashmap_taste(struct g_class *mp, struct g_provider *pp, int flags)
+{
+ struct g_geom *gp = NULL;
+ struct g_consumer *cp;
+ struct g_flashmap_head head;
+ struct g_flashmap_slice *slice, *slice_temp;
+ device_t dev;
+ int nslices, size;
+
+ g_trace(G_T_TOPOLOGY, "flashmap_taste(%s,%s)", mp->name, pp->name);
+ g_topology_assert();
+
+ if (flags == G_TF_NORMAL &&
+ !strcmp(pp->geom->class->name, FLASHMAP_CLASS_NAME))
+ return (NULL);
+
+ gp = g_slice_new(mp, FLASH_SLICES_MAX_NUM, pp, &cp, NULL, 0,
+ g_flashmap_start);
+ if (gp == NULL)
+ return (NULL);
+
+ STAILQ_INIT(&head);
+
+ do {
+ size = sizeof(device_t);
+ if (g_io_getattr("NAND::device", cp, &size, &dev))
+ break;
+
+ nslices = g_flashmap_load(dev, &head);
+ if (nslices == 0)
+ break;
+
+ g_flashmap_modify(gp, cp->provider->name,
+ cp->provider->sectorsize, &head);
+ } while (0);
+
+ g_access(cp, -1, 0, 0);
+
+ STAILQ_FOREACH_SAFE(slice, &head, sl_link, slice_temp) {
+ free(slice, M_FLASHMAP);
+ }
+
+ if (LIST_EMPTY(&gp->provider)) {
+ g_slice_spoiled(cp);
+ return (NULL);
+ }
+ return (gp);
+}
+
+static void
+g_flashmap_config(struct gctl_req *req, struct g_class *mp, const char *verb)
+{
+
+ gctl_error(req, "unknown config verb");
+}
+
+static int
+g_flashmap_load(device_t dev, struct g_flashmap_head *head)
+{
+ struct flash_slice *slices;
+ struct g_flashmap_slice *slice;
+ uint32_t i, buf_size;
+ int nslices = 0;
+
+ buf_size = sizeof(struct flash_slice) * FLASH_SLICES_MAX_NUM;
+ slices = malloc(buf_size, M_FLASHMAP, M_WAITOK | M_ZERO);
+ if (flash_fill_slices(dev, slices, &nslices) == 0) {
+ for (i = 0; i < nslices; i++) {
+ slice = malloc(sizeof(struct g_flashmap_slice),
+ M_FLASHMAP, M_WAITOK);
+
+ slice->sl_name = slices[i].label;
+ slice->sl_start = slices[i].base;
+ slice->sl_end = slices[i].base + slices[i].size - 1;
+
+ STAILQ_INSERT_TAIL(head, slice, sl_link);
+ }
+ }
+
+ free(slices, M_FLASHMAP);
+ return (nslices);
+}
+
+static struct g_class g_flashmap_class = {
+ .name = FLASHMAP_CLASS_NAME,
+ .version = G_VERSION,
+ .taste = g_flashmap_taste,
+ .dumpconf = g_flashmap_dumpconf,
+ .ioctl = g_flashmap_ioctl,
+ .ctlreq = g_flashmap_config,
+};
+
+DECLARE_GEOM_CLASS(g_flashmap_class, g_flashmap);
OpenPOWER on IntegriCloud