perf callchain: Use al.addr to set up call chain
[linux/fpc-iii.git] / drivers / usb / renesas_usbhs / mod.c
blob9a705b15b3a1528b733c9eebac04e0d2f7ef2ee9
1 /*
2 * Renesas USB driver
4 * Copyright (C) 2011 Renesas Solutions Corp.
5 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
12 * You should have received a copy of the GNU General Public License
13 * along with this program; if not, write to the Free Software
14 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
17 #include <linux/interrupt.h>
19 #include "common.h"
20 #include "mod.h"
22 #define usbhs_priv_to_modinfo(priv) (&priv->mod_info)
23 #define usbhs_mod_info_call(priv, func, param...) \
24 ({ \
25 struct usbhs_mod_info *info; \
26 info = usbhs_priv_to_modinfo(priv); \
27 !info->func ? 0 : \
28 info->func(param); \
32 * autonomy
34 * these functions are used if platform doesn't have external phy.
35 * -> there is no "notify_hotplug" callback from platform
36 * -> call "notify_hotplug" by itself
37 * -> use own interrupt to connect/disconnect
38 * -> it mean module clock is always ON
39 * ~~~~~~~~~~~~~~~~~~~~~~~~~
41 static int usbhsm_autonomy_get_vbus(struct platform_device *pdev)
43 struct usbhs_priv *priv = usbhs_pdev_to_priv(pdev);
45 return VBSTS & usbhs_read(priv, INTSTS0);
48 static int usbhsm_autonomy_irq_vbus(struct usbhs_priv *priv,
49 struct usbhs_irq_state *irq_state)
51 struct platform_device *pdev = usbhs_priv_to_pdev(priv);
53 renesas_usbhs_call_notify_hotplug(pdev);
55 return 0;
58 void usbhs_mod_autonomy_mode(struct usbhs_priv *priv)
60 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
62 info->irq_vbus = usbhsm_autonomy_irq_vbus;
63 priv->pfunc.get_vbus = usbhsm_autonomy_get_vbus;
65 usbhs_irq_callback_update(priv, NULL);
69 * host / gadget functions
71 * renesas_usbhs host/gadget can register itself by below functions.
72 * these functions are called when probe
75 void usbhs_mod_register(struct usbhs_priv *priv, struct usbhs_mod *mod, int id)
77 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
79 info->mod[id] = mod;
80 mod->priv = priv;
83 struct usbhs_mod *usbhs_mod_get(struct usbhs_priv *priv, int id)
85 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
86 struct usbhs_mod *ret = NULL;
88 switch (id) {
89 case USBHS_HOST:
90 case USBHS_GADGET:
91 ret = info->mod[id];
92 break;
95 return ret;
98 int usbhs_mod_is_host(struct usbhs_priv *priv)
100 struct usbhs_mod *mod = usbhs_mod_get_current(priv);
101 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
103 if (!mod)
104 return -EINVAL;
106 return info->mod[USBHS_HOST] == mod;
109 struct usbhs_mod *usbhs_mod_get_current(struct usbhs_priv *priv)
111 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
113 return info->curt;
116 int usbhs_mod_change(struct usbhs_priv *priv, int id)
118 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
119 struct usbhs_mod *mod = NULL;
120 int ret = 0;
122 /* id < 0 mean no current */
123 switch (id) {
124 case USBHS_HOST:
125 case USBHS_GADGET:
126 mod = info->mod[id];
127 break;
128 default:
129 ret = -EINVAL;
131 info->curt = mod;
133 return ret;
136 static irqreturn_t usbhs_interrupt(int irq, void *data);
137 int usbhs_mod_probe(struct usbhs_priv *priv)
139 struct device *dev = usbhs_priv_to_dev(priv);
140 int ret;
143 * install host/gadget driver
145 ret = usbhs_mod_host_probe(priv);
146 if (ret < 0)
147 return ret;
149 ret = usbhs_mod_gadget_probe(priv);
150 if (ret < 0)
151 goto mod_init_host_err;
153 /* irq settings */
154 ret = devm_request_irq(dev, priv->irq, usbhs_interrupt,
155 priv->irqflags, dev_name(dev), priv);
156 if (ret) {
157 dev_err(dev, "irq request err\n");
158 goto mod_init_gadget_err;
161 return ret;
163 mod_init_gadget_err:
164 usbhs_mod_gadget_remove(priv);
165 mod_init_host_err:
166 usbhs_mod_host_remove(priv);
168 return ret;
171 void usbhs_mod_remove(struct usbhs_priv *priv)
173 usbhs_mod_host_remove(priv);
174 usbhs_mod_gadget_remove(priv);
178 * status functions
180 int usbhs_status_get_device_state(struct usbhs_irq_state *irq_state)
182 int state = irq_state->intsts0 & DVSQ_MASK;
184 switch (state) {
185 case POWER_STATE:
186 case DEFAULT_STATE:
187 case ADDRESS_STATE:
188 case CONFIGURATION_STATE:
189 return state;
192 return -EIO;
195 int usbhs_status_get_ctrl_stage(struct usbhs_irq_state *irq_state)
198 * return value
200 * IDLE_SETUP_STAGE
201 * READ_DATA_STAGE
202 * READ_STATUS_STAGE
203 * WRITE_DATA_STAGE
204 * WRITE_STATUS_STAGE
205 * NODATA_STATUS_STAGE
206 * SEQUENCE_ERROR
208 return (int)irq_state->intsts0 & CTSQ_MASK;
211 static int usbhs_status_get_each_irq(struct usbhs_priv *priv,
212 struct usbhs_irq_state *state)
214 struct usbhs_mod *mod = usbhs_mod_get_current(priv);
215 u16 intenb0, intenb1;
216 unsigned long flags;
218 /******************** spin lock ********************/
219 usbhs_lock(priv, flags);
220 state->intsts0 = usbhs_read(priv, INTSTS0);
221 state->intsts1 = usbhs_read(priv, INTSTS1);
223 intenb0 = usbhs_read(priv, INTENB0);
224 intenb1 = usbhs_read(priv, INTENB1);
226 /* mask */
227 if (mod) {
228 state->brdysts = usbhs_read(priv, BRDYSTS);
229 state->nrdysts = usbhs_read(priv, NRDYSTS);
230 state->bempsts = usbhs_read(priv, BEMPSTS);
232 state->bempsts &= mod->irq_bempsts;
233 state->brdysts &= mod->irq_brdysts;
235 usbhs_unlock(priv, flags);
236 /******************** spin unlock ******************/
239 * Check whether the irq enable registers and the irq status are set
240 * when IRQF_SHARED is set.
242 if (priv->irqflags & IRQF_SHARED) {
243 if (!(intenb0 & state->intsts0) &&
244 !(intenb1 & state->intsts1) &&
245 !(state->bempsts) &&
246 !(state->brdysts))
247 return -EIO;
250 return 0;
254 * interrupt
256 #define INTSTS0_MAGIC 0xF800 /* acknowledge magical interrupt sources */
257 #define INTSTS1_MAGIC 0xA870 /* acknowledge magical interrupt sources */
258 static irqreturn_t usbhs_interrupt(int irq, void *data)
260 struct usbhs_priv *priv = data;
261 struct usbhs_irq_state irq_state;
263 if (usbhs_status_get_each_irq(priv, &irq_state) < 0)
264 return IRQ_NONE;
267 * clear interrupt
269 * The hardware is _very_ picky to clear interrupt bit.
270 * Especially INTSTS0_MAGIC, INTSTS1_MAGIC value.
272 * see
273 * "Operation"
274 * - "Control Transfer (DCP)"
275 * - Function :: VALID bit should 0
277 usbhs_write(priv, INTSTS0, ~irq_state.intsts0 & INTSTS0_MAGIC);
278 usbhs_write(priv, INTSTS1, ~irq_state.intsts1 & INTSTS1_MAGIC);
280 usbhs_write(priv, BRDYSTS, ~irq_state.brdysts);
281 usbhs_write(priv, NRDYSTS, ~irq_state.nrdysts);
282 usbhs_write(priv, BEMPSTS, ~irq_state.bempsts);
285 * call irq callback functions
286 * see also
287 * usbhs_irq_setting_update
290 /* INTSTS0 */
291 if (irq_state.intsts0 & VBINT)
292 usbhs_mod_info_call(priv, irq_vbus, priv, &irq_state);
294 if (irq_state.intsts0 & DVST)
295 usbhs_mod_call(priv, irq_dev_state, priv, &irq_state);
297 if (irq_state.intsts0 & CTRT)
298 usbhs_mod_call(priv, irq_ctrl_stage, priv, &irq_state);
300 if (irq_state.intsts0 & BEMP)
301 usbhs_mod_call(priv, irq_empty, priv, &irq_state);
303 if (irq_state.intsts0 & BRDY)
304 usbhs_mod_call(priv, irq_ready, priv, &irq_state);
306 /* INTSTS1 */
307 if (irq_state.intsts1 & ATTCH)
308 usbhs_mod_call(priv, irq_attch, priv, &irq_state);
310 if (irq_state.intsts1 & DTCH)
311 usbhs_mod_call(priv, irq_dtch, priv, &irq_state);
313 if (irq_state.intsts1 & SIGN)
314 usbhs_mod_call(priv, irq_sign, priv, &irq_state);
316 if (irq_state.intsts1 & SACK)
317 usbhs_mod_call(priv, irq_sack, priv, &irq_state);
319 return IRQ_HANDLED;
322 void usbhs_irq_callback_update(struct usbhs_priv *priv, struct usbhs_mod *mod)
324 u16 intenb0 = 0;
325 u16 intenb1 = 0;
326 struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
329 * BEMPENB/BRDYENB are picky.
330 * below method is required
332 * - clear INTSTS0
333 * - update BEMPENB/BRDYENB
334 * - update INTSTS0
336 usbhs_write(priv, INTENB0, 0);
337 usbhs_write(priv, INTENB1, 0);
339 usbhs_write(priv, BEMPENB, 0);
340 usbhs_write(priv, BRDYENB, 0);
343 * see also
344 * usbhs_interrupt
348 * it don't enable DVSE (intenb0) here
349 * but "mod->irq_dev_state" will be called.
351 if (info->irq_vbus)
352 intenb0 |= VBSE;
354 if (mod) {
356 * INTSTS0
358 if (mod->irq_ctrl_stage)
359 intenb0 |= CTRE;
361 if (mod->irq_empty && mod->irq_bempsts) {
362 usbhs_write(priv, BEMPENB, mod->irq_bempsts);
363 intenb0 |= BEMPE;
366 if (mod->irq_ready && mod->irq_brdysts) {
367 usbhs_write(priv, BRDYENB, mod->irq_brdysts);
368 intenb0 |= BRDYE;
372 * INTSTS1
374 if (mod->irq_attch)
375 intenb1 |= ATTCHE;
377 if (mod->irq_dtch)
378 intenb1 |= DTCHE;
380 if (mod->irq_sign)
381 intenb1 |= SIGNE;
383 if (mod->irq_sack)
384 intenb1 |= SACKE;
387 if (intenb0)
388 usbhs_write(priv, INTENB0, intenb0);
390 if (intenb1)
391 usbhs_write(priv, INTENB1, intenb1);