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