Differential D24917 Diff 71992 sys/arm/freescale/vybrid/vf_i2c_fdt.c

Changeset View

Standalone View

sys/arm/freescale/vybrid/vf_i2c_fdt.c

This file was added.

				/*-
				* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
				*
				* Copyright (c) 2014 Ruslan Bukin <br@bsdpad.com>
				* 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/systm.h>
				#include <sys/bus.h>
				#include <sys/kernel.h>
				#include <sys/module.h>
				#include <sys/malloc.h>
				#include <sys/rman.h>

				#include <dev/ofw/openfirm.h>
				#include <dev/ofw/ofw_bus.h>
				#include <dev/ofw/ofw_bus_subr.h>

				#ifdef EXT_RESOURCES
				#include <dev/extres/clk/clk.h>
				#endif

				#include <arm/freescale/vybrid/vf_i2c.h>

				static const struct ofw_compat_data i2c_compat_data[] = {
				{"fsl,mvf600-i2c", HW_MVF600},
				{"fsl,vf610-i2c", HW_VF610},
				{NULL, HW_UNKNOWN}
				};

				static int
				i2c_fdt_probe(device_t dev)
				{

				if (!ofw_bus_status_okay(dev))
				return (ENXIO);

				if (!ofw_bus_search_compatible(dev, i2c_compat_data)->ocd_data)
				return (ENXIO);

				device_set_desc(dev, VF_I2C_DEVSTR);
				return (BUS_PROBE_DEFAULT);
				}

				static int
				i2c_fdt_attach(device_t dev)
				{
				struct i2c_softc *sc;
				#ifdef EXT_RESOURCES
				phandle_t node;
				#endif
				int error;

				sc = device_get_softc(dev);
				sc->dev = dev;
				sc->hwtype = ofw_bus_search_compatible(dev, i2c_compat_data)->ocd_data;
				#ifdef EXT_RESOURCES
				node = ofw_bus_get_node(dev);

				error = clk_get_by_ofw_index(dev, node, 0, &sc->clock);
				if (error != 0) {
				sc->freq = 0;
				device_printf(dev, "Parent clock not found.\n");
				} else {
				if (OF_hasprop(node, "clock-frequency"))
				OF_getencprop(node, "clock-frequency", &sc->freq,
				sizeof(sc->freq));
				else
				sc->freq = 100000;
				}
				#endif

				return vf_i2c_attach_common(dev);
				}

				static phandle_t
				i2c_get_node(device_t bus, device_t dev)
				{

				return ofw_bus_get_node(bus);
				}

				static device_method_t i2c_fdt_methods[] = {
				DEVMETHOD(device_probe, i2c_fdt_probe),
				DEVMETHOD(device_attach, i2c_fdt_attach),

				DEVMETHOD(ofw_bus_get_node, i2c_get_node),

				{ 0, 0 }
				};

				DEFINE_CLASS_1(i2c, vf_i2c_fdt_driver, i2c_fdt_methods,
				sizeof(struct i2c_softc), vf_i2c_driver);

				static devclass_t vf_i2c_fdt_devclass;

				DRIVER_MODULE(i2c, simplebus, vf_i2c_fdt_driver, vf_i2c_fdt_devclass, 0, 0);
				DRIVER_MODULE(iicbus, i2c, iicbus_driver, iicbus_devclass, 0, 0);
				DRIVER_MODULE(ofw_iicbus, i2c, ofw_iicbus_driver, ofw_iicbus_devclass, 0, 0);