sys/powerpc/mikrotik/platform_rb.c

   1 /*-
   2  * Copyright (c) 2015 Justin Hibbits
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  *
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  */
  26
  27 #include <sys/cdefs.h>
  28 __FBSDID("$FreeBSD$");
  29
  30 #include <sys/param.h>
  31 #include <sys/systm.h>
  32 #include <sys/kernel.h>
  33 #include <sys/bus.h>
  34 #include <sys/malloc.h>
  35 #include <sys/slicer.h>
  36 #include <sys/smp.h>
  37
  38 #include <machine/platform.h>
  39 #include <machine/platformvar.h>
  40
  41 #include <dev/nand/nand.h>
  42 #include <dev/ofw/openfirm.h>
  43 #include <geom/geom_disk.h>
  44
  45 #include <powerpc/mpc85xx/mpc85xx.h>
  46
  47 #include "platform_if.h"
  48
  49 static int rb_probe(platform_t);
  50 static int rb_attach(platform_t);
  51
  52 static platform_method_t rb_methods[] = {
  53         PLATFORMMETHOD(platform_probe,          rb_probe),
  54         PLATFORMMETHOD(platform_attach,         rb_attach),
  55         PLATFORMMETHOD_END
  56 };
  57
  58 DEFINE_CLASS_1(rb, rb_platform, rb_methods, 0, mpc85xx_platform);
  59
  60 PLATFORM_DEF(rb_platform);
  61
  62 /* Slicer operates on the NAND controller, so we have to find the chip. */
  63 static int
  64 rb_nand_slicer(device_t dev, struct flash_slice *slices, int *nslices)
  65 {
  66         struct nand_chip *chip;
  67         device_t *children;
  68         int n;
  69
  70         if (device_get_children(dev, &children, &n) != 0) {
  71                 panic("Slicer called on controller with no child!");
  72         }
  73         dev = children[0];
  74         free(children, M_TEMP);
  75
  76         if (device_get_children(dev, &children, &n) != 0) {
  77                 panic("Slicer called on controller with nandbus but no child!");
  78         }
  79         dev = children[0];
  80         free(children, M_TEMP);
  81
  82         chip = device_get_softc(dev);
  83         *nslices = 2;
  84         slices[0].base = 0;
  85         slices[0].size = 4 * 1024 * 1024;
  86         slices[0].label = "boot";
  87
  88         slices[1].base = 4 * 1024 * 1024;
  89         slices[1].size = chip->ndisk->d_mediasize - slices[0].size;
  90         slices[1].label = "rootfs";
  91
  92         return (0);
  93 }
  94
  95 static int
  96 rb_probe(platform_t plat)
  97 {
  98         phandle_t rootnode;
  99         char model[32];
 100
 101         rootnode = OF_finddevice("/");
 102
 103         if (OF_getprop(rootnode, "model", model, sizeof(model)) > 0) {
 104                 if (strcmp(model, "RB800") == 0)
 105                         return (BUS_PROBE_SPECIFIC);
 106         }
 107
 108         return (ENXIO);
 109 }
 110
 111 static int
 112 rb_attach(platform_t plat)
 113 {
 114         int error;
 115
 116         error = mpc85xx_attach(plat);
 117         if (error)
 118                 return (error);
 119
 120         flash_register_slicer(rb_nand_slicer);
 121
 122         return (0);
 123 }