From 85cd1d67e91a7d4357a8128fc245f4a84429ce63 Mon Sep 17 00:00:00 2001 From: Patrick Wildt Date: Wed, 2 May 2018 15:17:31 +0000 Subject: Add imxpd(4) which is a power domain controller driver that essentially calls into ATF to make it supply power. ok kettenis@ --- sys/arch/arm64/conf/GENERIC | 3 +- sys/arch/arm64/conf/RAMDISK | 3 +- sys/arch/arm64/include/cpufunc.h | 4 +- sys/dev/fdt/files.fdt | 6 ++- sys/dev/fdt/imxpd.c | 84 ++++++++++++++++++++++++++++++++++++++++ 5 files changed, 96 insertions(+), 4 deletions(-) create mode 100644 sys/dev/fdt/imxpd.c (limited to 'sys') diff --git a/sys/arch/arm64/conf/GENERIC b/sys/arch/arm64/conf/GENERIC index eb3ff619fcf..d7b7dca12bf 100644 --- a/sys/arch/arm64/conf/GENERIC +++ b/sys/arch/arm64/conf/GENERIC @@ -1,4 +1,4 @@ -# $OpenBSD: GENERIC,v 1.68 2018/04/24 11:23:27 kettenis Exp $ +# $OpenBSD: GENERIC,v 1.69 2018/05/02 15:17:30 patrick Exp $ # # GENERIC machine description file # @@ -98,6 +98,7 @@ imxiic* at fdt? iic* at imxiic? imxesdhc* at fdt? sdmmc* at imxesdhc? +imxpd* at fdt? # Raspberry Pi 3 bcmaux* at fdt? diff --git a/sys/arch/arm64/conf/RAMDISK b/sys/arch/arm64/conf/RAMDISK index c7b6621994a..1211e7245d9 100644 --- a/sys/arch/arm64/conf/RAMDISK +++ b/sys/arch/arm64/conf/RAMDISK @@ -1,4 +1,4 @@ -# $OpenBSD: RAMDISK,v 1.57 2018/04/07 18:31:22 kettenis Exp $ +# $OpenBSD: RAMDISK,v 1.58 2018/05/02 15:17:30 patrick Exp $ # # GENERIC machine description file # @@ -104,6 +104,7 @@ imxiic* at fdt? iic* at imxiic? imxesdhc* at fdt? sdmmc* at imxesdhc? +imxpd* at fdt? # Raspberry Pi 3 bcmaux* at fdt? diff --git a/sys/arch/arm64/include/cpufunc.h b/sys/arch/arm64/include/cpufunc.h index b8beb85c831..055350a56df 100644 --- a/sys/arch/arm64/include/cpufunc.h +++ b/sys/arch/arm64/include/cpufunc.h @@ -1,4 +1,4 @@ -/* $OpenBSD: cpufunc.h,v 1.3 2018/01/10 23:27:18 kettenis Exp $ */ +/* $OpenBSD: cpufunc.h,v 1.4 2018/05/02 15:17:30 patrick Exp $ */ /*- * Copyright (c) 2014 Andrew Turner * All rights reserved. @@ -50,5 +50,7 @@ void cpu_dcache_wbinv_range(vaddr_t, vsize_t); void cpu_dcache_inv_range(vaddr_t, vsize_t); void cpu_dcache_wb_range(vaddr_t, vsize_t); +register_t smc_call(register_t, register_t, register_t, register_t); + #endif /* _KERNEL */ #endif /* _MACHINE_CPUFUNC_H_ */ diff --git a/sys/dev/fdt/files.fdt b/sys/dev/fdt/files.fdt index 4c58981bb48..995c17ca45a 100644 --- a/sys/dev/fdt/files.fdt +++ b/sys/dev/fdt/files.fdt @@ -1,4 +1,4 @@ -# $OpenBSD: files.fdt,v 1.58 2018/04/20 04:37:21 dlg Exp $ +# $OpenBSD: files.fdt,v 1.59 2018/05/02 15:17:30 patrick Exp $ # # Config file and device description for machine-independent FDT code. # Included by ports that need it. @@ -222,6 +222,10 @@ device imxiomuxc attach imxiomuxc at fdt file dev/fdt/imxiomuxc.c imxiomuxc +device imxpd: fdt +attach imxpd at fdt +file dev/fdt/imxpd.c imxpd + device imxuart attach imxuart at fdt file dev/fdt/imxuart.c imxuart diff --git a/sys/dev/fdt/imxpd.c b/sys/dev/fdt/imxpd.c new file mode 100644 index 00000000000..caccc3a996b --- /dev/null +++ b/sys/dev/fdt/imxpd.c @@ -0,0 +1,84 @@ +/* $OpenBSD: imxpd.c,v 1.1 2018/05/02 15:17:30 patrick Exp $ */ +/* + * Copyright (c) 2018 Patrick Wildt + * + * Permission to use, copy, modify, and distribute this software for any + * purpose with or without fee is hereby granted, provided that the above + * copyright notice and this permission notice appear in all copies. + * + * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES + * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF + * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR + * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES + * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN + * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF + * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. + */ + +#include +#include +#include +#include + +#include +#include + +#include +#include + +#define FSL_SIP_GPC 0xc2000000 +#define FSL_SIP_CONFIG_GPC_PM_DOMAIN 0x03 + +struct imxpd_softc { + struct device sc_dev; + struct power_domain_device sc_pd; + int sc_domain_id; +}; + +int imxpd_match(struct device *, void *, void *); +void imxpd_attach(struct device *, struct device *, void *); + +void imxpd_enable(void *, uint32_t *, int); + + +struct cfattach imxpd_ca = { + sizeof (struct imxpd_softc), imxpd_match, imxpd_attach +}; + +struct cfdriver imxpd_cd = { + NULL, "imxpd", DV_DULL +}; + +int +imxpd_match(struct device *parent, void *match, void *aux) +{ + struct fdt_attach_args *faa = aux; + + return OF_is_compatible(faa->fa_node, "fsl,imx8mq-pm-domain"); +} + +void +imxpd_attach(struct device *parent, struct device *self, void *aux) +{ + struct imxpd_softc *sc = (struct imxpd_softc *)self; + struct fdt_attach_args *faa = aux; + + sc->sc_domain_id = OF_getpropint(faa->fa_node, "domain-id", 0); + + sc->sc_pd.pd_node = faa->fa_node; + sc->sc_pd.pd_cookie = sc; + sc->sc_pd.pd_enable = imxpd_enable; + power_domain_register(&sc->sc_pd); + + printf("\n"); +} + +void +imxpd_enable(void *cookie, uint32_t *cells, int on) +{ + struct imxpd_softc *sc = cookie; + + /* Set up power domain */ + smc_call(FSL_SIP_GPC, FSL_SIP_CONFIG_GPC_PM_DOMAIN, + sc->sc_domain_id, on); +} -- cgit v1.2.3