1*be82b3a0SEmmanuel Vadot /*-
2*be82b3a0SEmmanuel Vadot * Copyright 2016 Michal Meloun <mmel@FreeBSD.org>
3*be82b3a0SEmmanuel Vadot * All rights reserved.
4*be82b3a0SEmmanuel Vadot *
5*be82b3a0SEmmanuel Vadot * Redistribution and use in source and binary forms, with or without
6*be82b3a0SEmmanuel Vadot * modification, are permitted provided that the following conditions
7*be82b3a0SEmmanuel Vadot * are met:
8*be82b3a0SEmmanuel Vadot * 1. Redistributions of source code must retain the above copyright
9*be82b3a0SEmmanuel Vadot * notice, this list of conditions and the following disclaimer.
10*be82b3a0SEmmanuel Vadot * 2. Redistributions in binary form must reproduce the above copyright
11*be82b3a0SEmmanuel Vadot * notice, this list of conditions and the following disclaimer in the
12*be82b3a0SEmmanuel Vadot * documentation and/or other materials provided with the distribution.
13*be82b3a0SEmmanuel Vadot *
14*be82b3a0SEmmanuel Vadot * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15*be82b3a0SEmmanuel Vadot * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16*be82b3a0SEmmanuel Vadot * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17*be82b3a0SEmmanuel Vadot * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18*be82b3a0SEmmanuel Vadot * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19*be82b3a0SEmmanuel Vadot * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20*be82b3a0SEmmanuel Vadot * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21*be82b3a0SEmmanuel Vadot * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22*be82b3a0SEmmanuel Vadot * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23*be82b3a0SEmmanuel Vadot * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24*be82b3a0SEmmanuel Vadot * SUCH DAMAGE.
25*be82b3a0SEmmanuel Vadot */
26*be82b3a0SEmmanuel Vadot
27*be82b3a0SEmmanuel Vadot #include <sys/param.h>
28*be82b3a0SEmmanuel Vadot #include <sys/conf.h>
29*be82b3a0SEmmanuel Vadot #include <sys/bus.h>
30*be82b3a0SEmmanuel Vadot #include <sys/kernel.h>
31*be82b3a0SEmmanuel Vadot #include <sys/kobj.h>
32*be82b3a0SEmmanuel Vadot #include <sys/malloc.h>
33*be82b3a0SEmmanuel Vadot #include <sys/mutex.h>
34*be82b3a0SEmmanuel Vadot #include <sys/module.h>
35*be82b3a0SEmmanuel Vadot #include <sys/rman.h>
36*be82b3a0SEmmanuel Vadot #include <sys/systm.h>
37*be82b3a0SEmmanuel Vadot
38*be82b3a0SEmmanuel Vadot #include <machine/bus.h>
39*be82b3a0SEmmanuel Vadot
40*be82b3a0SEmmanuel Vadot #include <dev/clk/clk_link.h>
41*be82b3a0SEmmanuel Vadot
42*be82b3a0SEmmanuel Vadot static int clknode_link_init(struct clknode *clk, device_t dev);
43*be82b3a0SEmmanuel Vadot static int clknode_link_recalc(struct clknode *clk, uint64_t *freq);
44*be82b3a0SEmmanuel Vadot static int clknode_link_set_freq(struct clknode *clk, uint64_t fin,
45*be82b3a0SEmmanuel Vadot uint64_t *fout, int flags, int *stop);
46*be82b3a0SEmmanuel Vadot static int clknode_link_set_mux(struct clknode *clk, int idx);
47*be82b3a0SEmmanuel Vadot static int clknode_link_set_gate(struct clknode *clk, bool enable);
48*be82b3a0SEmmanuel Vadot
49*be82b3a0SEmmanuel Vadot static clknode_method_t clknode_link_methods[] = {
50*be82b3a0SEmmanuel Vadot /* Device interface */
51*be82b3a0SEmmanuel Vadot CLKNODEMETHOD(clknode_init, clknode_link_init),
52*be82b3a0SEmmanuel Vadot CLKNODEMETHOD(clknode_recalc_freq, clknode_link_recalc),
53*be82b3a0SEmmanuel Vadot CLKNODEMETHOD(clknode_set_freq, clknode_link_set_freq),
54*be82b3a0SEmmanuel Vadot CLKNODEMETHOD(clknode_set_gate, clknode_link_set_gate),
55*be82b3a0SEmmanuel Vadot CLKNODEMETHOD(clknode_set_mux, clknode_link_set_mux),
56*be82b3a0SEmmanuel Vadot CLKNODEMETHOD_END
57*be82b3a0SEmmanuel Vadot };
58*be82b3a0SEmmanuel Vadot DEFINE_CLASS_1(clknode_link, clknode_link_class, clknode_link_methods,
59*be82b3a0SEmmanuel Vadot 0, clknode_class);
60*be82b3a0SEmmanuel Vadot
61*be82b3a0SEmmanuel Vadot static int
clknode_link_init(struct clknode * clk,device_t dev)62*be82b3a0SEmmanuel Vadot clknode_link_init(struct clknode *clk, device_t dev)
63*be82b3a0SEmmanuel Vadot {
64*be82b3a0SEmmanuel Vadot return(0);
65*be82b3a0SEmmanuel Vadot }
66*be82b3a0SEmmanuel Vadot
67*be82b3a0SEmmanuel Vadot static int
clknode_link_recalc(struct clknode * clk,uint64_t * freq)68*be82b3a0SEmmanuel Vadot clknode_link_recalc(struct clknode *clk, uint64_t *freq)
69*be82b3a0SEmmanuel Vadot {
70*be82b3a0SEmmanuel Vadot
71*be82b3a0SEmmanuel Vadot printf("%s: Attempt to use unresolved linked clock: %s\n", __func__,
72*be82b3a0SEmmanuel Vadot clknode_get_name(clk));
73*be82b3a0SEmmanuel Vadot return (EBADF);
74*be82b3a0SEmmanuel Vadot }
75*be82b3a0SEmmanuel Vadot
76*be82b3a0SEmmanuel Vadot static int
clknode_link_set_freq(struct clknode * clk,uint64_t fin,uint64_t * fout,int flags,int * stop)77*be82b3a0SEmmanuel Vadot clknode_link_set_freq(struct clknode *clk, uint64_t fin, uint64_t *fout,
78*be82b3a0SEmmanuel Vadot int flags, int *stop)
79*be82b3a0SEmmanuel Vadot {
80*be82b3a0SEmmanuel Vadot
81*be82b3a0SEmmanuel Vadot printf("%s: Attempt to use unresolved linked clock: %s\n", __func__,
82*be82b3a0SEmmanuel Vadot clknode_get_name(clk));
83*be82b3a0SEmmanuel Vadot return (EBADF);
84*be82b3a0SEmmanuel Vadot }
85*be82b3a0SEmmanuel Vadot
86*be82b3a0SEmmanuel Vadot static int
clknode_link_set_mux(struct clknode * clk,int idx)87*be82b3a0SEmmanuel Vadot clknode_link_set_mux(struct clknode *clk, int idx)
88*be82b3a0SEmmanuel Vadot {
89*be82b3a0SEmmanuel Vadot
90*be82b3a0SEmmanuel Vadot printf("%s: Attempt to use unresolved linked clock: %s\n", __func__,
91*be82b3a0SEmmanuel Vadot clknode_get_name(clk));
92*be82b3a0SEmmanuel Vadot return (EBADF);
93*be82b3a0SEmmanuel Vadot }
94*be82b3a0SEmmanuel Vadot
95*be82b3a0SEmmanuel Vadot static int
clknode_link_set_gate(struct clknode * clk,bool enable)96*be82b3a0SEmmanuel Vadot clknode_link_set_gate(struct clknode *clk, bool enable)
97*be82b3a0SEmmanuel Vadot {
98*be82b3a0SEmmanuel Vadot
99*be82b3a0SEmmanuel Vadot printf("%s: Attempt to use unresolved linked clock: %s\n", __func__,
100*be82b3a0SEmmanuel Vadot clknode_get_name(clk));
101*be82b3a0SEmmanuel Vadot return (EBADF);
102*be82b3a0SEmmanuel Vadot }
103*be82b3a0SEmmanuel Vadot
104*be82b3a0SEmmanuel Vadot int
clknode_link_register(struct clkdom * clkdom,struct clk_link_def * clkdef)105*be82b3a0SEmmanuel Vadot clknode_link_register(struct clkdom *clkdom, struct clk_link_def *clkdef)
106*be82b3a0SEmmanuel Vadot {
107*be82b3a0SEmmanuel Vadot struct clknode *clk;
108*be82b3a0SEmmanuel Vadot struct clknode_init_def tmp;
109*be82b3a0SEmmanuel Vadot
110*be82b3a0SEmmanuel Vadot tmp = clkdef->clkdef;
111*be82b3a0SEmmanuel Vadot tmp.flags |= CLK_NODE_LINKED;
112*be82b3a0SEmmanuel Vadot clk = clknode_create(clkdom, &clknode_link_class, &tmp);
113*be82b3a0SEmmanuel Vadot if (clk == NULL)
114*be82b3a0SEmmanuel Vadot return (1);
115*be82b3a0SEmmanuel Vadot clknode_register(clkdom, clk);
116*be82b3a0SEmmanuel Vadot return (0);
117*be82b3a0SEmmanuel Vadot }
118