config root man

/*-
 * Copyright (c) 2000 KIYOHARA Takashi <kiyohara@kk.iij4u.ne.jp>
 * Copyright (c) 2000 Takanori Watanabe <takawata@jp.FreeBSD.org>
 * 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.
 *
 * $FreeBSD: release/9.1.0/sys/pc98/pc98/canbus.c 212413 2010-09-10 11:19:03Z avg $
 */

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/bus.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/module.h>
#include <sys/sysctl.h>


#include <machine/bus.h>
#include <machine/resource.h>
#include <sys/rman.h>

#include <pc98/pc98/canbus.h>
#include <pc98/pc98/canbusvars.h>
#include "canbus_if.h"


#define CANBE_IO_DELAY_TIME 5000


static MALLOC_DEFINE(M_CANBUSDEV, "canbusdev", "CanBe device");
struct canbus_device {
	struct resource_list cbdev_resources;
};

/* canbus softc */
struct canbus_softc {
	int io_delay_time;			/* CanBe I/O delay time */

	struct sysctl_ctx_list canbus_sysctl_ctx;
						/* dynamic sysctl tree */

	/* index register */
	int index_id;				/* index ID */
	struct resource *index_res;		/* index resouce */
	bus_space_tag_t index_tag;		/* index tag */
	bus_space_handle_t index_handle;	/* index handle */

	/* data register */
	int data_id;				/* data ID */
	struct resource *data_res;		/* data resouce */
	bus_space_tag_t data_tag;		/* data tag */
	bus_space_handle_t data_handle;		/* data handle */
};


/* Device interface methods */
static void	canbus_identify(driver_t *, device_t);
static int	canbus_probe(device_t);
static int	canbus_attach(device_t);
static int	canbus_detach(device_t);

/* Bus interface methods */
static int	canbus_print_child(device_t, device_t);
static device_t	canbus_add_child(device_t, u_int, const char *, int);
static struct resource *	canbus_alloc_resource(
    device_t, device_t, int, int *, u_long, u_long, u_long, u_int);
static int	canbus_activate_resource(
    device_t, device_t, int, int, struct resource *);
static int	canbus_deactivate_resource(
    device_t, device_t, int, int, struct resource *);
static int	canbus_release_resource(
    device_t, device_t, int, int, struct resource *);
static int	canbus_set_resource (
    device_t, device_t, int, int, u_long, u_long);
static void	canbus_delete_resource(device_t, device_t, int, int);

/* canbus local function */
static void	set_ioresource(device_t dev);
static void	delete_ioresource(device_t dev);
static int	alloc_ioresource(device_t);
static void	release_ioresource(device_t);
static int	print_all_resources(device_t);

static device_method_t canbus_methods[] = { 
	/* Device interface */
	DEVMETHOD(device_identify,	canbus_identify),
	DEVMETHOD(device_probe,		canbus_probe),
	DEVMETHOD(device_attach,	canbus_attach),
	DEVMETHOD(device_detach,	canbus_detach),

	/* Bus interface */
	DEVMETHOD(bus_print_child,	canbus_print_child),
	DEVMETHOD(bus_add_child,	canbus_add_child),
	DEVMETHOD(bus_alloc_resource,	canbus_alloc_resource),
	DEVMETHOD(bus_activate_resource,	canbus_activate_resource),
	DEVMETHOD(bus_deactivate_resource,	canbus_deactivate_resource),
	DEVMETHOD(bus_release_resource,	canbus_release_resource),
	DEVMETHOD(bus_setup_intr,	bus_generic_setup_intr),
	DEVMETHOD(bus_teardown_intr,	bus_generic_teardown_intr),
	DEVMETHOD(bus_set_resource,	canbus_set_resource),
	DEVMETHOD(bus_delete_resource,	canbus_delete_resource),

	/* CanBe interface */
	DEVMETHOD(canbus_read,		canbus_read),
	DEVMETHOD(canbus_write,		canbus_write),
	DEVMETHOD(canbus_write_multi,	canbus_write_multi),

	{0, 0}
};

static driver_t canbus_driver = {
	"canbus",
	canbus_methods,
	sizeof(struct canbus_softc),
};

devclass_t canbus_devclass;
DRIVER_MODULE(canbus, nexus, canbus_driver, canbus_devclass, 0, 0);
MODULE_VERSION(canbus, 1);


static void
canbus_identify(driver_t *drv, device_t parent)
{
	if (device_find_child(parent, "canbus", 0) == NULL) {
		if (BUS_ADD_CHILD(parent, 33, "canbus", 0) == NULL)
			device_printf(parent, "canbus cannot attach\n");
	}
}


static int
canbus_probe(device_t dev)
{
	u_int8_t flag;

	set_ioresource(dev);
	if(alloc_ioresource(dev))
		return (ENXIO);
	flag = canbus_read(dev, NULL, CANBE_SOUND_INTR_ADDR);
	release_ioresource(dev);

	if (bootverbose)
		device_printf(dev, "probe flag = 0x%x\n", flag);

	if (flag != CANBE_SOUND_INTR_VAL0 && flag != CANBE_SOUND_INTR_VAL1 &&
	    flag != CANBE_SOUND_INTR_VAL2 && flag != CANBE_SOUND_INTR_VAL3) {
		device_printf(dev, "Device Not Found\n");
		return (ENXIO);
	}
	device_set_desc(dev, "CanBe I/O Bus");

	return (0);	
}

static int
canbus_attach(device_t dev)
{
	struct canbus_softc *sc = device_get_softc(dev);
	struct sysctl_oid *canbus_sysctl_tree;

	sc->io_delay_time = CANBE_IO_DELAY_TIME;

	/* I/O resource setup */
	if(alloc_ioresource(dev))
		return (ENXIO);

	/* Dynamic sysctl tree setup */
	sysctl_ctx_init(&sc->canbus_sysctl_ctx);
	canbus_sysctl_tree = SYSCTL_ADD_NODE(&sc->canbus_sysctl_ctx,
	    SYSCTL_STATIC_CHILDREN(/* tree top */), OID_AUTO,
	    "canbus", CTLFLAG_RD, 0, "CanBe I/O Bus");
	SYSCTL_ADD_INT(&sc->canbus_sysctl_ctx,
	    SYSCTL_CHILDREN(canbus_sysctl_tree), OID_AUTO, "io_delay_time",
	    CTLFLAG_RW, &sc->io_delay_time, 0, "CanBe Bus I/O delay time");

	bus_generic_probe(dev);
	bus_generic_attach(dev);

	return (0);
}


static int
canbus_detach(device_t dev)
{
	struct canbus_softc *sc = device_get_softc(dev);

	/* I/O resource free */
	release_ioresource(dev);
	delete_ioresource(dev);

	/* Dynamic sysctl tree destroy */
	if (sysctl_ctx_free(&sc->canbus_sysctl_ctx)) {
		device_printf(dev,
		    "can't free this context - other oids depend on it\n");
		return (ENOTEMPTY);
	}

	return (0);
}


static int
canbus_print_child(device_t dev, device_t child)
{
	int     retval = 0;

	retval += bus_print_child_header(dev, child);
	retval += print_all_resources(child);
	retval += bus_print_child_footer(dev, child);

	return (retval);
}

static device_t
canbus_add_child(device_t bus, u_int order, const char *name, int unit)
{
	device_t child;
	struct canbus_device *cbdev;

	child = device_add_child_ordered(bus, order, name, unit);

	cbdev = malloc(
	    sizeof(struct canbus_device), M_CANBUSDEV, M_NOWAIT | M_ZERO);
	if (!cbdev)
		return (0);

	resource_list_init(&cbdev->cbdev_resources);
	device_set_ivars(child, cbdev);

	return (child);
}

static struct resource *
canbus_alloc_resource(device_t dev, device_t child, int type,
    int *rid, u_long start, u_long end, u_long count, u_int flags)
{
	return (BUS_ALLOC_RESOURCE(device_get_parent(dev),
	    child, type, rid, start, end, count, flags));
}

static int
canbus_activate_resource(
    device_t dev, device_t child, int type, int rid, struct resource *res)
{
	return (BUS_ACTIVATE_RESOURCE(
	    device_get_parent(dev), child, type, rid, res));
}

static int
canbus_deactivate_resource(
    device_t dev, device_t child, int type, int rid, struct resource *res)
{
	return (BUS_DEACTIVATE_RESOURCE(
	    device_get_parent(dev), child, type, rid, res));
}

static int
canbus_release_resource(
    device_t dev, device_t child, int type, int rid, struct resource *res)
{
	return (BUS_RELEASE_RESOURCE(
	    device_get_parent(dev), child, type, rid, res));
}

static int
canbus_set_resource (
    device_t dev, device_t child, int type, int rid, u_long start, u_long count)
{
	struct  canbus_device *cbdev =
	    (struct canbus_device *)device_get_ivars(child);
	struct resource_list *rl = &cbdev->cbdev_resources;

	resource_list_add(rl, type, rid, start, (start + count - 1), count);

	return (0);
}

static void
canbus_delete_resource(device_t dev, device_t child, int type, int rid)
{
        struct  canbus_device *cbdev =
	    (struct canbus_device *)device_get_ivars(child);
        struct resource_list *rl = &cbdev->cbdev_resources;

        resource_list_delete(rl, type, rid);
}


u_int8_t
canbus_read(device_t dev, device_t child, int reg)
{
	struct canbus_softc *sc = device_get_softc(dev);

	bus_space_write_1(sc->index_tag, sc->index_handle, 0, reg);
	return (bus_space_read_1(sc->data_tag, sc->data_handle, 0));
}

void
canbus_write(device_t dev, device_t child, int reg, u_int8_t val)
{
	struct canbus_softc *sc = device_get_softc(dev);

	bus_space_write_1(sc->index_tag, sc->index_handle, 0, reg);
	bus_space_write_1(sc->data_tag, sc->data_handle, 0, val);
}

void
canbus_write_multi(device_t dev,
    device_t child, int reg, const int count, const u_int8_t *vals)
{
	struct canbus_softc *sc = device_get_softc(dev);
	int i;

	bus_space_write_1(sc->index_tag, sc->index_handle, 0, reg);

	for (i = 0; i < count; i ++) {
		bus_space_write_1(sc->data_tag, sc->data_handle, 0, vals[i]);
		DELAY(sc->io_delay_time);
	}
}

void
canbus_delay(device_t dev, device_t child)
{
	struct canbus_softc *sc = device_get_softc(dev);

	DELAY(sc->io_delay_time);
}


/*
 * canbus local function.
 */

/*
 * CanBe I/O resource set function
 */
static void
set_ioresource(device_t dev)
{
	struct canbus_softc *sc = device_get_softc(dev);

	sc->index_id = 0;
	sc->data_id = 1;

	bus_set_resource(
	    dev, SYS_RES_IOPORT, sc->index_id, CANBE_IOPORT_INDEX, 1);
	bus_set_resource(
	    dev, SYS_RES_IOPORT, sc->data_id, CANBE_IOPORT_DATA, 1);
}

/*
 * CanBe I/O resource delete function
 */
static void
delete_ioresource(device_t dev)
{
	struct canbus_softc *sc = device_get_softc(dev);

	bus_delete_resource(dev, SYS_RES_IOPORT, sc->index_id);
	bus_delete_resource(dev, SYS_RES_IOPORT, sc->data_id);
}

/*
 * CanBe I/O resource alloc function
 */
static int
alloc_ioresource(device_t dev)
{
	struct canbus_softc *sc = device_get_softc(dev);

	sc->index_res = bus_alloc_resource_any(
	    dev, SYS_RES_IOPORT, &sc->index_id, RF_ACTIVE);
	sc->data_res = bus_alloc_resource_any(
	    dev, SYS_RES_IOPORT, &sc->data_id, RF_ACTIVE);
	if (sc->index_res == NULL || sc->data_res == NULL) {
		device_printf(dev, "could not map I/O\n");
		return (ENXIO);
	}

	sc->index_tag = rman_get_bustag(sc->index_res);
	sc->index_handle = rman_get_bushandle(sc->index_res);
	sc->data_tag = rman_get_bustag(sc->data_res);
	sc->data_handle = rman_get_bushandle(sc->data_res);

	return (0);
}

/*
 * CanBe I/O resource release function
 */
static void
release_ioresource(device_t dev)
{
	struct canbus_softc *sc = device_get_softc(dev);

	bus_release_resource(dev, SYS_RES_IOPORT, sc->index_id, sc->index_res);
	bus_release_resource(dev, SYS_RES_IOPORT, sc->data_id, sc->data_res);
}


static int
print_all_resources(device_t dev)
{
	struct  canbus_device *cbdev =
	    (struct canbus_device *)device_get_ivars(dev);
	struct resource_list *rl = &cbdev->cbdev_resources;
	int retval = 0;

	if (STAILQ_FIRST(rl))
		retval += printf(" at");

	retval += resource_list_print_type(rl, "port", SYS_RES_IOPORT, "%#lx");
	retval += resource_list_print_type(rl, "iomem", SYS_RES_MEMORY, "%#lx");
	retval += resource_list_print_type(rl, "irq", SYS_RES_IRQ, "%ld");

	return retval;
}