From ea25a064d1117662183cfee35c273fbc94767885 Mon Sep 17 00:00:00 2001 From: kettenis Date: Sun, 21 Aug 2016 21:38:05 +0000 Subject: [PATCH] Add a minimal clock "framework". Build it on armv7. ok patrick@ --- sys/arch/armv7/conf/files.armv7 | 3 +- sys/dev/ofw/ofw_clock.c | 212 ++++++++++++++++++++++++++++++++ sys/dev/ofw/ofw_clock.h | 39 ++++++ 3 files changed, 253 insertions(+), 1 deletion(-) create mode 100644 sys/dev/ofw/ofw_clock.c create mode 100644 sys/dev/ofw/ofw_clock.h diff --git a/sys/arch/armv7/conf/files.armv7 b/sys/arch/armv7/conf/files.armv7 index 60a9e2bb68e..43ecf147581 100644 --- a/sys/arch/armv7/conf/files.armv7 +++ b/sys/arch/armv7/conf/files.armv7 @@ -1,4 +1,4 @@ -# $OpenBSD: files.armv7,v 1.24 2016/08/15 13:42:49 patrick Exp $ +# $OpenBSD: files.armv7,v 1.25 2016/08/21 21:38:05 kettenis Exp $ maxpartitions 16 maxusers 2 8 64 @@ -25,6 +25,7 @@ file arch/armv7/armv7/platform.c file arch/arm/arm/disksubr.c disk # FDT support +file dev/ofw/ofw_clock.c file dev/ofw/ofw_gpio.c file dev/ofw/ofw_pinctrl.c file dev/ofw/ofw_regulator.c diff --git a/sys/dev/ofw/ofw_clock.c b/sys/dev/ofw/ofw_clock.c new file mode 100644 index 00000000000..0159d48a84c --- /dev/null +++ b/sys/dev/ofw/ofw_clock.c @@ -0,0 +1,212 @@ +/* $OpenBSD: ofw_clock.c,v 1.1 2016/08/21 21:38:05 kettenis Exp $ */ +/* + * Copyright (c) 2016 Mark Kettenis + * + * 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 + +LIST_HEAD(, clock_device) clock_devices = + LIST_HEAD_INITIALIZER(clock_devices); + +void +clock_register(struct clock_device *cd) +{ + cd->cd_cells = OF_getpropint(cd->cd_node, "#clock-cells", 0); + cd->cd_phandle = OF_getpropint(cd->cd_node, "phandle", 0); + if (cd->cd_phandle == 0) + return; + + LIST_INSERT_HEAD(&clock_devices, cd, cd_list); +} + +uint32_t +clock_get_frequency_cells(uint32_t *cells) +{ + struct clock_device *cd; + uint32_t phandle = cells[0]; + int node; + + LIST_FOREACH(cd, &clock_devices, cd_list) { + if (cd->cd_phandle == phandle) + break; + } + + if (cd && cd->cd_get_frequency) + return cd->cd_get_frequency(cd->cd_cookie, &cells[1]); + + node = OF_getnodebyphandle(phandle); + if (node == 0) + return 0; + + if (OF_is_compatible(node, "fixed-clock")) + return OF_getpropint(node, "clock-frequency", 0); + + if (OF_is_compatible(node, "fixed-factor-clock")) { + uint32_t mult, div, freq; + + mult = OF_getpropint(node, "clock-mult", 1); + div = OF_getpropint(node, "clock-div", 1); + freq = clock_get_frequency(node, NULL); + return (freq * mult) / div; + } + + return 0; +} + +void +clock_enable_cells(uint32_t *cells) +{ + struct clock_device *cd; + uint32_t phandle = cells[0]; + + LIST_FOREACH(cd, &clock_devices, cd_list) { + if (cd->cd_phandle == phandle) + break; + } + + if (cd && cd->cd_enable) + cd->cd_enable(cd->cd_cookie, &cells[1], 1); +} + +uint32_t * +clock_next_clock(uint32_t *cells) +{ + uint32_t phandle = cells[0]; + int node, ncells; + + node = OF_getnodebyphandle(phandle); + if (node == 0) + return NULL; + + ncells = OF_getpropint(node, "#clock-cells", 0); + return cells + ncells + 1; +} + +int +clock_index(int node, const char *clock) +{ + char *names; + char *name; + char *end; + int idx = 0; + int len; + + if (clock == NULL) + return 0; + + len = OF_getproplen(node, "clock-names"); + if (len <= 0) + return -1; + + names = malloc(len, M_TEMP, M_WAITOK); + OF_getprop(node, "clock-names", names, len); + end = names + len; + name = names; + while (name < end) { + if (strcmp(name, clock) == 0) { + free(names, M_TEMP, len); + return idx; + } + name += strlen(name) + 1; + idx++; + } + free(names, M_TEMP, len); + return -1; +} + +uint32_t +clock_get_frequency_idx(int node, int idx) +{ + uint32_t *clocks; + uint32_t *clock; + uint32_t freq = 0; + int len; + + len = OF_getproplen(node, "clocks"); + if (len <= 0) + return 0; + + clocks = malloc(len, M_TEMP, M_WAITOK); + OF_getpropintarray(node, "clocks", clocks, len); + + clock = clocks; + while (clock && clock < clocks + (len / sizeof(uint32_t))) { + if (idx == 0) { + freq = clock_get_frequency_cells(clock); + break; + } + clock = clock_next_clock(clock); + idx--; + } + + free(clocks, M_TEMP, len); + return freq; +} + +uint32_t +clock_get_frequency(int node, const char *name) +{ + int idx; + + idx = clock_index(node, name); + if (idx == -1) + return 0; + + return clock_get_frequency_idx(node, idx); +} + +void +clock_enable_idx(int node, int idx) +{ + uint32_t *clocks; + uint32_t *clock; + int len; + + len = OF_getproplen(node, "clocks"); + if (len <= 0) + return; + + clocks = malloc(len, M_TEMP, M_WAITOK); + OF_getpropintarray(node, "clocks", clocks, len); + + clock = clocks; + while (clock && clock < clocks + (len / sizeof(uint32_t))) { + if (idx == 0) { + clock_enable_cells(clock); + break; + } + clock = clock_next_clock(clock); + idx--; + } + + free(clocks, M_TEMP, len); +} + +void +clock_enable(int node, const char *name) +{ + int idx; + + idx = clock_index(node, name); + if (idx == -1) + return; + + clock_enable_idx(node, idx); +} diff --git a/sys/dev/ofw/ofw_clock.h b/sys/dev/ofw/ofw_clock.h new file mode 100644 index 00000000000..eaa4143453c --- /dev/null +++ b/sys/dev/ofw/ofw_clock.h @@ -0,0 +1,39 @@ +/* $OpenBSD: ofw_clock.h,v 1.1 2016/08/21 21:38:05 kettenis Exp $ */ +/* + * Copyright (c) 2016 Mark Kettenis + * + * 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. + */ + +#ifndef _DEV_OFW_CLOCK_H_ +#define _DEV_OFW_CLOCK_H_ + +struct clock_device { + int cd_node; + void *cd_cookie; + uint32_t (*cd_get_frequency)(void *, uint32_t *); + void (*cd_enable)(void *, uint32_t *, int); + + LIST_ENTRY(clock_device) cd_list; + uint32_t cd_phandle; + uint32_t cd_cells; +}; + +void clock_register(struct clock_device *); + +uint32_t clock_get_frequency(int, const char *); +uint32_t clock_get_frequency_idx(int, int); +void clock_enable(int, const char *); +void clock_enable_idx(int, int); + +#endif /* _DEV_OFW_CLOCK_H_ */ -- 2.20.1