Source-Changes-HG archive
[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index][Old Index]
[src/trunk]: src/sys/dev/fdt Add FDT PHY interface.
details: https://anonhg.NetBSD.org/src/rev/e1c8e1f5e70b
branches: trunk
changeset: 354774:e1c8e1f5e70b
user: jmcneill <jmcneill%NetBSD.org@localhost>
date: Thu Jun 29 17:04:17 2017 +0000
description:
Add FDT PHY interface.
diffstat:
sys/dev/fdt/fdt_phy.c | 181 ++++++++++++++++++++++++++++++++++++++++++++++++++
sys/dev/fdt/fdtvar.h | 22 +++++-
sys/dev/fdt/files.fdt | 3 +-
3 files changed, 204 insertions(+), 2 deletions(-)
diffs (252 lines):
diff -r e0d9af0de26f -r e1c8e1f5e70b sys/dev/fdt/fdt_phy.c
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/sys/dev/fdt/fdt_phy.c Thu Jun 29 17:04:17 2017 +0000
@@ -0,0 +1,181 @@
+/* $NetBSD: fdt_phy.c,v 1.1 2017/06/29 17:04:17 jmcneill Exp $ */
+
+/*-
+ * Copyright (c) 2015-2017 Jared McNeill <jmcneill%invisible.ca@localhost>
+ * 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 ``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 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>
+__KERNEL_RCSID(0, "$NetBSD: fdt_phy.c,v 1.1 2017/06/29 17:04:17 jmcneill Exp $");
+
+#include <sys/param.h>
+#include <sys/bus.h>
+#include <sys/kmem.h>
+
+#include <libfdt.h>
+#include <dev/fdt/fdtvar.h>
+
+struct fdtbus_phy_controller {
+ device_t pc_dev;
+ int pc_phandle;
+ const struct fdtbus_phy_controller_func *pc_funcs;
+
+ struct fdtbus_phy_controller *pc_next;
+};
+
+static struct fdtbus_phy_controller *fdtbus_pc = NULL;
+
+int
+fdtbus_register_phy_controller(device_t dev, int phandle,
+ const struct fdtbus_phy_controller_func *funcs)
+{
+ struct fdtbus_phy_controller *pc;
+
+ pc = kmem_alloc(sizeof(*pc), KM_SLEEP);
+ pc->pc_dev = dev;
+ pc->pc_phandle = phandle;
+ pc->pc_funcs = funcs;
+
+ pc->pc_next = fdtbus_pc;
+ fdtbus_pc = pc;
+
+ return 0;
+}
+
+static struct fdtbus_phy_controller *
+fdtbus_get_phy_controller(int phandle)
+{
+ struct fdtbus_phy_controller *pc;
+
+ for (pc = fdtbus_pc; pc; pc = pc->pc_next) {
+ if (pc->pc_phandle == phandle) {
+ return pc;
+ }
+ }
+
+ return NULL;
+}
+
+struct fdtbus_phy *
+fdtbus_phy_get_index(int phandle, u_int index)
+{
+ struct fdtbus_phy_controller *pc;
+ struct fdtbus_phy *phy = NULL;
+ void *phy_priv = NULL;
+ uint32_t *phys = NULL;
+ uint32_t *p;
+ u_int n, phy_cells;
+ int len, resid;
+
+ len = OF_getproplen(phandle, "phys");
+ if (len <= 0)
+ return NULL;
+
+ phys = kmem_alloc(len, KM_SLEEP);
+ if (OF_getprop(phandle, "phys", phys, len) != len) {
+ kmem_free(phys, len);
+ return NULL;
+ }
+
+ p = phys;
+ for (n = 0, resid = len; resid > 0; n++) {
+ const int pc_phandle =
+ fdtbus_get_phandle_from_native(be32toh(p[0]));
+ if (of_getprop_uint32(pc_phandle, "#phy-cells", &phy_cells))
+ break;
+ if (n == index) {
+ pc = fdtbus_get_phy_controller(pc_phandle);
+ if (pc == NULL)
+ goto done;
+ phy_priv = pc->pc_funcs->acquire(pc->pc_dev,
+ phy_cells > 0 ? &p[1] : NULL, phy_cells * 4);
+ if (phy_priv) {
+ phy = kmem_alloc(sizeof(*phy), KM_SLEEP);
+ phy->phy_pc = pc;
+ phy->phy_priv = phy_priv;
+ }
+ break;
+ }
+ resid -= (phy_cells + 1) * 4;
+ p += phy_cells + 1;
+ }
+
+done:
+ if (phys)
+ kmem_free(phys, len);
+
+ return phy;
+}
+
+struct fdtbus_phy *
+fdtbus_phy_get(int phandle, const char *phyname)
+{
+ struct fdtbus_phy *phy = NULL;
+ char *phy_names = NULL;
+ const char *p;
+ u_int index;
+ int len, resid;
+
+ len = OF_getproplen(phandle, "phy-names");
+ if (len <= 0)
+ return NULL;
+
+ phy_names = kmem_alloc(len, KM_SLEEP);
+ if (OF_getprop(phandle, "phy-names", phy_names, len) != len) {
+ kmem_free(phy_names, len);
+ return NULL;
+ }
+
+ p = phy_names;
+ for (index = 0, resid = len; resid > 0; index++) {
+ if (strcmp(p, phyname) == 0) {
+ phy = fdtbus_phy_get_index(phandle, index);
+ break;
+ }
+ resid -= strlen(p);
+ p += strlen(p) + 1;
+ }
+
+ if (phy_names)
+ kmem_free(phy_names, len);
+
+ return phy;
+}
+
+void
+fdtbus_phy_put(struct fdtbus_phy *phy)
+{
+ struct fdtbus_phy_controller *pc = phy->phy_pc;
+
+ pc->pc_funcs->release(pc->pc_dev, phy->phy_priv);
+ kmem_free(phy, sizeof(*phy));
+}
+
+int
+fdtbus_phy_enable(struct fdtbus_phy *phy, bool enable)
+{
+ struct fdtbus_phy_controller *pc = phy->phy_pc;
+
+ return pc->pc_funcs->enable(pc->pc_dev, phy->phy_priv, enable);
+}
diff -r e0d9af0de26f -r e1c8e1f5e70b sys/dev/fdt/fdtvar.h
--- a/sys/dev/fdt/fdtvar.h Thu Jun 29 10:53:59 2017 +0000
+++ b/sys/dev/fdt/fdtvar.h Thu Jun 29 17:04:17 2017 +0000
@@ -1,4 +1,4 @@
-/* $NetBSD: fdtvar.h,v 1.20 2017/06/02 13:53:29 jmcneill Exp $ */
+/* $NetBSD: fdtvar.h,v 1.21 2017/06/29 17:04:17 jmcneill Exp $ */
/*-
* Copyright (c) 2015 Jared D. McNeill <jmcneill%invisible.ca@localhost>
@@ -172,6 +172,19 @@
void (*poweroff)(device_t);
};
+struct fdtbus_phy_controller;
+
+struct fdtbus_phy {
+ struct fdtbus_phy_controller *phy_pc;
+ void *phy_priv;
+};
+
+struct fdtbus_phy_controller_func {
+ void * (*acquire)(device_t, const void *, size_t);
+ void (*release)(device_t, void *);
+ int (*enable)(device_t, void *, bool);
+};
+
struct fdt_console {
int (*match)(int);
void (*consinit)(struct fdt_attach_args *, u_int);
@@ -210,6 +223,8 @@
const struct fdtbus_dma_controller_func *);
int fdtbus_register_power_controller(device_t, int,
const struct fdtbus_power_controller_func *);
+int fdtbus_register_phy_controller(device_t, int,
+ const struct fdtbus_phy_controller_func *);
int fdtbus_get_reg(int, u_int, bus_addr_t *, bus_size_t *);
int fdtbus_get_reg64(int, u_int, uint64_t *, uint64_t *);
@@ -254,6 +269,11 @@
int fdtbus_reset_assert(struct fdtbus_reset *);
int fdtbus_reset_deassert(struct fdtbus_reset *);
+struct fdtbus_phy *fdtbus_phy_get(int, const char *);
+struct fdtbus_phy *fdtbus_phy_get_index(int, u_int);
+void fdtbus_phy_put(struct fdtbus_phy *);
+int fdtbus_phy_enable(struct fdtbus_phy *, bool);
+
int fdtbus_todr_attach(device_t, int, todr_chip_handle_t);
void fdtbus_power_reset(void);
diff -r e0d9af0de26f -r e1c8e1f5e70b sys/dev/fdt/files.fdt
--- a/sys/dev/fdt/files.fdt Thu Jun 29 10:53:59 2017 +0000
+++ b/sys/dev/fdt/files.fdt Thu Jun 29 17:04:17 2017 +0000
@@ -1,4 +1,4 @@
-# $NetBSD: files.fdt,v 1.16 2017/06/03 14:48:03 jmcneill Exp $
+# $NetBSD: files.fdt,v 1.17 2017/06/29 17:04:17 jmcneill Exp $
include "external/bsd/libfdt/conf/files.libfdt"
@@ -29,6 +29,7 @@
file dev/fdt/fdt_gpio.c fdtbus
file dev/fdt/fdt_i2c.c fdtbus
file dev/fdt/fdt_intr.c fdtbus
+file dev/fdt/fdt_phy.c fdtbus
file dev/fdt/fdt_power.c fdtbus
file dev/fdt/fdt_regulator.c fdtbus
file dev/fdt/fdt_reset.c fdtbus
Home |
Main Index |
Thread Index |
Old Index