blob: 6fcfd6997c88d32a312b7ec2fb0b919a870b874b [file] [log] [blame]
Simon Glassf26c8a82015-06-23 15:39:15 -06001/*
2 * Copyright (C) 2015 Google, Inc
3 * Written by Simon Glass <sjg@chromium.org>
Stephen Warren135aa952016-06-17 09:44:00 -06004 * Copyright (c) 2016, NVIDIA CORPORATION.
Simon Glassf26c8a82015-06-23 15:39:15 -06005 *
6 * SPDX-License-Identifier: GPL-2.0+
7 */
8
9#include <common.h>
10#include <clk.h>
Stephen Warren135aa952016-06-17 09:44:00 -060011#include <clk-uclass.h>
Simon Glassf26c8a82015-06-23 15:39:15 -060012#include <dm.h>
Simon Glass7423daa2016-07-04 11:58:03 -060013#include <dt-structs.h>
Simon Glassf26c8a82015-06-23 15:39:15 -060014#include <errno.h>
Simon Glassf26c8a82015-06-23 15:39:15 -060015
Simon Glasse70cc432016-01-20 19:43:02 -070016DECLARE_GLOBAL_DATA_PTR;
17
Stephen Warren135aa952016-06-17 09:44:00 -060018static inline struct clk_ops *clk_dev_ops(struct udevice *dev)
Simon Glassf26c8a82015-06-23 15:39:15 -060019{
Stephen Warren135aa952016-06-17 09:44:00 -060020 return (struct clk_ops *)dev->driver->ops;
Simon Glassf26c8a82015-06-23 15:39:15 -060021}
22
Simon Glasse70cc432016-01-20 19:43:02 -070023#if CONFIG_IS_ENABLED(OF_CONTROL)
Simon Glass7423daa2016-07-04 11:58:03 -060024# if CONFIG_IS_ENABLED(OF_PLATDATA)
25int clk_get_by_index_platdata(struct udevice *dev, int index,
26 struct phandle_2_cell *cells, struct clk *clk)
27{
28 int ret;
29
30 if (index != 0)
31 return -ENOSYS;
32 ret = uclass_get_device(UCLASS_CLK, 0, &clk->dev);
33 if (ret)
34 return ret;
35 clk->id = cells[0].id;
36
37 return 0;
38}
39# else
Stephen Warren135aa952016-06-17 09:44:00 -060040static int clk_of_xlate_default(struct clk *clk,
41 struct fdtdec_phandle_args *args)
42{
43 debug("%s(clk=%p)\n", __func__, clk);
44
45 if (args->args_count > 1) {
46 debug("Invaild args_count: %d\n", args->args_count);
47 return -EINVAL;
48 }
49
50 if (args->args_count)
51 clk->id = args->args[0];
52 else
53 clk->id = 0;
54
55 return 0;
56}
57
58int clk_get_by_index(struct udevice *dev, int index, struct clk *clk)
59{
60 int ret;
61 struct fdtdec_phandle_args args;
62 struct udevice *dev_clk;
63 struct clk_ops *ops;
64
65 debug("%s(dev=%p, index=%d, clk=%p)\n", __func__, dev, index, clk);
66
67 assert(clk);
Simon Glasse160f7d2017-01-17 16:52:55 -070068 ret = fdtdec_parse_phandle_with_args(gd->fdt_blob, dev_of_offset(dev),
Simon Glasse70cc432016-01-20 19:43:02 -070069 "clocks", "#clock-cells", 0, index,
70 &args);
71 if (ret) {
72 debug("%s: fdtdec_parse_phandle_with_args failed: err=%d\n",
73 __func__, ret);
74 return ret;
75 }
76
Stephen Warren135aa952016-06-17 09:44:00 -060077 ret = uclass_get_device_by_of_offset(UCLASS_CLK, args.node, &dev_clk);
Simon Glasse70cc432016-01-20 19:43:02 -070078 if (ret) {
79 debug("%s: uclass_get_device_by_of_offset failed: err=%d\n",
80 __func__, ret);
81 return ret;
82 }
Wenyou Yang3f56b132016-09-27 11:00:28 +080083
84 clk->dev = dev_clk;
85
Stephen Warren135aa952016-06-17 09:44:00 -060086 ops = clk_dev_ops(dev_clk);
87
88 if (ops->of_xlate)
89 ret = ops->of_xlate(clk, &args);
90 else
91 ret = clk_of_xlate_default(clk, &args);
92 if (ret) {
93 debug("of_xlate() failed: %d\n", ret);
94 return ret;
95 }
96
97 return clk_request(dev_clk, clk);
98}
Michal Simek9e0758b2016-07-14 13:11:37 +020099# endif /* OF_PLATDATA */
Stephen Warren135aa952016-06-17 09:44:00 -0600100
101int clk_get_by_name(struct udevice *dev, const char *name, struct clk *clk)
102{
103 int index;
104
105 debug("%s(dev=%p, name=%s, clk=%p)\n", __func__, dev, name, clk);
106
Simon Glasse160f7d2017-01-17 16:52:55 -0700107 index = fdt_stringlist_search(gd->fdt_blob, dev_of_offset(dev),
Simon Glassb02e4042016-10-02 17:59:28 -0600108 "clock-names", name);
Stephen Warren135aa952016-06-17 09:44:00 -0600109 if (index < 0) {
Simon Glassb02e4042016-10-02 17:59:28 -0600110 debug("fdt_stringlist_search() failed: %d\n", index);
Stephen Warren135aa952016-06-17 09:44:00 -0600111 return index;
112 }
113
114 return clk_get_by_index(dev, index, clk);
Simon Glasse70cc432016-01-20 19:43:02 -0700115}
Simon Glass7423daa2016-07-04 11:58:03 -0600116#endif /* OF_CONTROL */
Stephen Warren135aa952016-06-17 09:44:00 -0600117
118int clk_request(struct udevice *dev, struct clk *clk)
119{
120 struct clk_ops *ops = clk_dev_ops(dev);
121
122 debug("%s(dev=%p, clk=%p)\n", __func__, dev, clk);
123
124 clk->dev = dev;
125
126 if (!ops->request)
127 return 0;
128
129 return ops->request(clk);
130}
131
132int clk_free(struct clk *clk)
133{
134 struct clk_ops *ops = clk_dev_ops(clk->dev);
135
136 debug("%s(clk=%p)\n", __func__, clk);
137
138 if (!ops->free)
139 return 0;
140
141 return ops->free(clk);
142}
143
144ulong clk_get_rate(struct clk *clk)
145{
146 struct clk_ops *ops = clk_dev_ops(clk->dev);
147
148 debug("%s(clk=%p)\n", __func__, clk);
149
150 if (!ops->get_rate)
151 return -ENOSYS;
152
153 return ops->get_rate(clk);
154}
155
156ulong clk_set_rate(struct clk *clk, ulong rate)
157{
158 struct clk_ops *ops = clk_dev_ops(clk->dev);
159
160 debug("%s(clk=%p, rate=%lu)\n", __func__, clk, rate);
161
162 if (!ops->set_rate)
163 return -ENOSYS;
164
165 return ops->set_rate(clk, rate);
166}
167
168int clk_enable(struct clk *clk)
169{
170 struct clk_ops *ops = clk_dev_ops(clk->dev);
171
172 debug("%s(clk=%p)\n", __func__, clk);
173
174 if (!ops->enable)
175 return -ENOSYS;
176
177 return ops->enable(clk);
178}
179
180int clk_disable(struct clk *clk)
181{
182 struct clk_ops *ops = clk_dev_ops(clk->dev);
183
184 debug("%s(clk=%p)\n", __func__, clk);
185
186 if (!ops->disable)
187 return -ENOSYS;
188
189 return ops->disable(clk);
190}
Simon Glasse70cc432016-01-20 19:43:02 -0700191
Simon Glassf26c8a82015-06-23 15:39:15 -0600192UCLASS_DRIVER(clk) = {
193 .id = UCLASS_CLK,
194 .name = "clk",
195};