Linux Audio

Check our new training course

Loading...
v4.6
 
  1/*
  2 * Renesas USB driver
  3 *
  4 * Copyright (C) 2011 Renesas Solutions Corp.
 
  5 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
  6 *
  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.
 11 *
 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
 15 *
 16 */
 17#include <linux/interrupt.h>
 18
 19#include "common.h"
 20#include "mod.h"
 21
 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);			\
 29})
 30
 31/*
 32 *		autonomy
 33 *
 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 *             ~~~~~~~~~~~~~~~~~~~~~~~~~
 40 */
 41static int usbhsm_autonomy_get_vbus(struct platform_device *pdev)
 42{
 43	struct usbhs_priv *priv = usbhs_pdev_to_priv(pdev);
 44
 45	return  VBSTS & usbhs_read(priv, INTSTS0);
 46}
 47
 48static int usbhsm_autonomy_irq_vbus(struct usbhs_priv *priv,
 49				    struct usbhs_irq_state *irq_state)
 50{
 51	struct platform_device *pdev = usbhs_priv_to_pdev(priv);
 52
 53	renesas_usbhs_call_notify_hotplug(pdev);
 54
 55	return 0;
 56}
 57
 58void usbhs_mod_autonomy_mode(struct usbhs_priv *priv)
 59{
 60	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
 61
 62	info->irq_vbus		= usbhsm_autonomy_irq_vbus;
 63	priv->pfunc.get_vbus	= usbhsm_autonomy_get_vbus;
 64
 65	usbhs_irq_callback_update(priv, NULL);
 66}
 67
 
 
 
 
 
 
 
 68/*
 69 *		host / gadget functions
 70 *
 71 * renesas_usbhs host/gadget can register itself by below functions.
 72 * these functions are called when probe
 73 *
 74 */
 75void usbhs_mod_register(struct usbhs_priv *priv, struct usbhs_mod *mod, int id)
 76{
 77	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
 78
 79	info->mod[id]	= mod;
 80	mod->priv	= priv;
 81}
 82
 83struct usbhs_mod *usbhs_mod_get(struct usbhs_priv *priv, int id)
 84{
 85	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
 86	struct usbhs_mod *ret = NULL;
 87
 88	switch (id) {
 89	case USBHS_HOST:
 90	case USBHS_GADGET:
 91		ret = info->mod[id];
 92		break;
 93	}
 94
 95	return ret;
 96}
 97
 98int usbhs_mod_is_host(struct usbhs_priv *priv)
 99{
100	struct usbhs_mod *mod = usbhs_mod_get_current(priv);
101	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
102
103	if (!mod)
104		return -EINVAL;
105
106	return info->mod[USBHS_HOST] == mod;
107}
108
109struct usbhs_mod *usbhs_mod_get_current(struct usbhs_priv *priv)
110{
111	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
112
113	return info->curt;
114}
115
116int usbhs_mod_change(struct usbhs_priv *priv, int id)
117{
118	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
119	struct usbhs_mod *mod = NULL;
120	int ret = 0;
121
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;
130	}
131	info->curt = mod;
132
133	return ret;
134}
135
136static irqreturn_t usbhs_interrupt(int irq, void *data);
137int usbhs_mod_probe(struct usbhs_priv *priv)
138{
139	struct device *dev = usbhs_priv_to_dev(priv);
140	int ret;
141
142	/*
143	 * install host/gadget driver
144	 */
145	ret = usbhs_mod_host_probe(priv);
146	if (ret < 0)
147		return ret;
148
149	ret = usbhs_mod_gadget_probe(priv);
150	if (ret < 0)
151		goto mod_init_host_err;
152
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;
159	}
160
161	return ret;
162
163mod_init_gadget_err:
164	usbhs_mod_gadget_remove(priv);
165mod_init_host_err:
166	usbhs_mod_host_remove(priv);
167
168	return ret;
169}
170
171void usbhs_mod_remove(struct usbhs_priv *priv)
172{
173	usbhs_mod_host_remove(priv);
174	usbhs_mod_gadget_remove(priv);
175}
176
177/*
178 *		status functions
179 */
180int usbhs_status_get_device_state(struct usbhs_irq_state *irq_state)
181{
182	int state = irq_state->intsts0 & DVSQ_MASK;
183
184	switch (state) {
185	case POWER_STATE:
186	case DEFAULT_STATE:
187	case ADDRESS_STATE:
188	case CONFIGURATION_STATE:
189		return state;
190	}
191
192	return -EIO;
193}
194
195int usbhs_status_get_ctrl_stage(struct usbhs_irq_state *irq_state)
196{
197	/*
198	 * return value
199	 *
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
207	 */
208	return (int)irq_state->intsts0 & CTSQ_MASK;
209}
210
211static int usbhs_status_get_each_irq(struct usbhs_priv *priv,
212				     struct usbhs_irq_state *state)
213{
214	struct usbhs_mod *mod = usbhs_mod_get_current(priv);
215	u16 intenb0, intenb1;
216	unsigned long flags;
217
218	/********************  spin lock ********************/
219	usbhs_lock(priv, flags);
220	state->intsts0 = usbhs_read(priv, INTSTS0);
221	intenb0 = usbhs_read(priv, INTENB0);
222
223	if (usbhs_mod_is_host(priv)) {
224		state->intsts1 = usbhs_read(priv, INTSTS1);
225		intenb1 = usbhs_read(priv, INTENB1);
226	} else {
227		state->intsts1 = intenb1 = 0;
228	}
229
230	/* mask */
231	if (mod) {
232		state->brdysts = usbhs_read(priv, BRDYSTS);
233		state->nrdysts = usbhs_read(priv, NRDYSTS);
234		state->bempsts = usbhs_read(priv, BEMPSTS);
235
236		state->bempsts &= mod->irq_bempsts;
237		state->brdysts &= mod->irq_brdysts;
238	}
239	usbhs_unlock(priv, flags);
240	/********************  spin unlock ******************/
241
242	/*
243	 * Check whether the irq enable registers and the irq status are set
244	 * when IRQF_SHARED is set.
245	 */
246	if (priv->irqflags & IRQF_SHARED) {
247		if (!(intenb0 & state->intsts0) &&
248		    !(intenb1 & state->intsts1) &&
249		    !(state->bempsts) &&
250		    !(state->brdysts))
251			return -EIO;
252	}
253
254	return 0;
255}
256
257/*
258 *		interrupt
259 */
260#define INTSTS0_MAGIC 0xF800 /* acknowledge magical interrupt sources */
261#define INTSTS1_MAGIC 0xA870 /* acknowledge magical interrupt sources */
262static irqreturn_t usbhs_interrupt(int irq, void *data)
263{
264	struct usbhs_priv *priv = data;
265	struct usbhs_irq_state irq_state;
266
267	if (usbhs_status_get_each_irq(priv, &irq_state) < 0)
268		return IRQ_NONE;
269
270	/*
271	 * clear interrupt
272	 *
273	 * The hardware is _very_ picky to clear interrupt bit.
274	 * Especially INTSTS0_MAGIC, INTSTS1_MAGIC value.
275	 *
276	 * see
277	 *	"Operation"
278	 *	 - "Control Transfer (DCP)"
279	 *	   - Function :: VALID bit should 0
280	 */
281	usbhs_write(priv, INTSTS0, ~irq_state.intsts0 & INTSTS0_MAGIC);
282	if (usbhs_mod_is_host(priv))
283		usbhs_write(priv, INTSTS1, ~irq_state.intsts1 & INTSTS1_MAGIC);
284
285	usbhs_write(priv, BRDYSTS, ~irq_state.brdysts);
 
 
 
 
 
 
286	usbhs_write(priv, NRDYSTS, ~irq_state.nrdysts);
287	usbhs_write(priv, BEMPSTS, ~irq_state.bempsts);
 
288
289	/*
290	 * call irq callback functions
291	 * see also
292	 *	usbhs_irq_setting_update
293	 */
294
295	/* INTSTS0 */
296	if (irq_state.intsts0 & VBINT)
297		usbhs_mod_info_call(priv, irq_vbus, priv, &irq_state);
298
299	if (irq_state.intsts0 & DVST)
300		usbhs_mod_call(priv, irq_dev_state, priv, &irq_state);
301
302	if (irq_state.intsts0 & CTRT)
303		usbhs_mod_call(priv, irq_ctrl_stage, priv, &irq_state);
304
305	if (irq_state.intsts0 & BEMP)
306		usbhs_mod_call(priv, irq_empty, priv, &irq_state);
307
308	if (irq_state.intsts0 & BRDY)
309		usbhs_mod_call(priv, irq_ready, priv, &irq_state);
310
311	if (usbhs_mod_is_host(priv)) {
312		/* INTSTS1 */
313		if (irq_state.intsts1 & ATTCH)
314			usbhs_mod_call(priv, irq_attch, priv, &irq_state);
315
316		if (irq_state.intsts1 & DTCH)
317			usbhs_mod_call(priv, irq_dtch, priv, &irq_state);
318
319		if (irq_state.intsts1 & SIGN)
320			usbhs_mod_call(priv, irq_sign, priv, &irq_state);
321
322		if (irq_state.intsts1 & SACK)
323			usbhs_mod_call(priv, irq_sack, priv, &irq_state);
324	}
325	return IRQ_HANDLED;
326}
327
328void usbhs_irq_callback_update(struct usbhs_priv *priv, struct usbhs_mod *mod)
329{
330	u16 intenb0 = 0;
331	u16 intenb1 = 0;
332	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
333
334	/*
335	 * BEMPENB/BRDYENB are picky.
336	 * below method is required
337	 *
338	 *  - clear  INTSTS0
339	 *  - update BEMPENB/BRDYENB
340	 *  - update INTSTS0
341	 */
342	usbhs_write(priv, INTENB0, 0);
343	if (usbhs_mod_is_host(priv))
344		usbhs_write(priv, INTENB1, 0);
345
346	usbhs_write(priv, BEMPENB, 0);
347	usbhs_write(priv, BRDYENB, 0);
348
349	/*
350	 * see also
351	 *	usbhs_interrupt
352	 */
353
354	/*
355	 * it don't enable DVSE (intenb0) here
356	 * but "mod->irq_dev_state" will be called.
357	 */
358	if (info->irq_vbus)
359		intenb0 |= VBSE;
360
361	if (mod) {
362		/*
363		 * INTSTS0
364		 */
365		if (mod->irq_ctrl_stage)
366			intenb0 |= CTRE;
367
368		if (mod->irq_empty && mod->irq_bempsts) {
369			usbhs_write(priv, BEMPENB, mod->irq_bempsts);
370			intenb0 |= BEMPE;
371		}
372
373		if (mod->irq_ready && mod->irq_brdysts) {
374			usbhs_write(priv, BRDYENB, mod->irq_brdysts);
375			intenb0 |= BRDYE;
376		}
377
378		if (usbhs_mod_is_host(priv)) {
379			/*
380			 * INTSTS1
381			 */
382			if (mod->irq_attch)
383				intenb1 |= ATTCHE;
384
385			if (mod->irq_dtch)
386				intenb1 |= DTCHE;
387
388			if (mod->irq_sign)
389				intenb1 |= SIGNE;
390
391			if (mod->irq_sack)
392				intenb1 |= SACKE;
393		}
394	}
395
396	if (intenb0)
397		usbhs_write(priv, INTENB0, intenb0);
398
399	if (usbhs_mod_is_host(priv) && intenb1)
400		usbhs_write(priv, INTENB1, intenb1);
401}
v5.4
  1// SPDX-License-Identifier: GPL-1.0+
  2/*
  3 * Renesas USB driver
  4 *
  5 * Copyright (C) 2011 Renesas Solutions Corp.
  6 * Copyright (C) 2019 Renesas Electronics Corporation
  7 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
 
 
 
 
 
 
 
 
 
 
  8 */
  9#include <linux/interrupt.h>
 10
 11#include "common.h"
 12#include "mod.h"
 13
 
 
 
 
 
 
 
 
 
 14/*
 15 *		autonomy
 16 *
 17 * these functions are used if platform doesn't have external phy.
 18 *  -> there is no "notify_hotplug" callback from platform
 19 *  -> call "notify_hotplug" by itself
 20 *  -> use own interrupt to connect/disconnect
 21 *  -> it mean module clock is always ON
 22 *             ~~~~~~~~~~~~~~~~~~~~~~~~~
 23 */
 24static int usbhsm_autonomy_get_vbus(struct platform_device *pdev)
 25{
 26	struct usbhs_priv *priv = usbhs_pdev_to_priv(pdev);
 27
 28	return  VBSTS & usbhs_read(priv, INTSTS0);
 29}
 30
 31static int usbhsm_autonomy_irq_vbus(struct usbhs_priv *priv,
 32				    struct usbhs_irq_state *irq_state)
 33{
 34	struct platform_device *pdev = usbhs_priv_to_pdev(priv);
 35
 36	usbhsc_schedule_notify_hotplug(pdev);
 37
 38	return 0;
 39}
 40
 41void usbhs_mod_autonomy_mode(struct usbhs_priv *priv)
 42{
 43	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
 44
 45	info->irq_vbus = usbhsm_autonomy_irq_vbus;
 46	info->get_vbus = usbhsm_autonomy_get_vbus;
 47
 48	usbhs_irq_callback_update(priv, NULL);
 49}
 50
 51void usbhs_mod_non_autonomy_mode(struct usbhs_priv *priv)
 52{
 53	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
 54
 55	info->get_vbus = priv->pfunc->get_vbus;
 56}
 57
 58/*
 59 *		host / gadget functions
 60 *
 61 * renesas_usbhs host/gadget can register itself by below functions.
 62 * these functions are called when probe
 63 *
 64 */
 65void usbhs_mod_register(struct usbhs_priv *priv, struct usbhs_mod *mod, int id)
 66{
 67	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
 68
 69	info->mod[id]	= mod;
 70	mod->priv	= priv;
 71}
 72
 73struct usbhs_mod *usbhs_mod_get(struct usbhs_priv *priv, int id)
 74{
 75	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
 76	struct usbhs_mod *ret = NULL;
 77
 78	switch (id) {
 79	case USBHS_HOST:
 80	case USBHS_GADGET:
 81		ret = info->mod[id];
 82		break;
 83	}
 84
 85	return ret;
 86}
 87
 88int usbhs_mod_is_host(struct usbhs_priv *priv)
 89{
 90	struct usbhs_mod *mod = usbhs_mod_get_current(priv);
 91	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
 92
 93	if (!mod)
 94		return -EINVAL;
 95
 96	return info->mod[USBHS_HOST] == mod;
 97}
 98
 99struct usbhs_mod *usbhs_mod_get_current(struct usbhs_priv *priv)
100{
101	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
102
103	return info->curt;
104}
105
106int usbhs_mod_change(struct usbhs_priv *priv, int id)
107{
108	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
109	struct usbhs_mod *mod = NULL;
110	int ret = 0;
111
112	/* id < 0 mean no current */
113	switch (id) {
114	case USBHS_HOST:
115	case USBHS_GADGET:
116		mod = info->mod[id];
117		break;
118	default:
119		ret = -EINVAL;
120	}
121	info->curt = mod;
122
123	return ret;
124}
125
126static irqreturn_t usbhs_interrupt(int irq, void *data);
127int usbhs_mod_probe(struct usbhs_priv *priv)
128{
129	struct device *dev = usbhs_priv_to_dev(priv);
130	int ret;
131
132	/*
133	 * install host/gadget driver
134	 */
135	ret = usbhs_mod_host_probe(priv);
136	if (ret < 0)
137		return ret;
138
139	ret = usbhs_mod_gadget_probe(priv);
140	if (ret < 0)
141		goto mod_init_host_err;
142
143	/* irq settings */
144	ret = devm_request_irq(dev, priv->irq, usbhs_interrupt,
145			  priv->irqflags, dev_name(dev), priv);
146	if (ret) {
147		dev_err(dev, "irq request err\n");
148		goto mod_init_gadget_err;
149	}
150
151	return ret;
152
153mod_init_gadget_err:
154	usbhs_mod_gadget_remove(priv);
155mod_init_host_err:
156	usbhs_mod_host_remove(priv);
157
158	return ret;
159}
160
161void usbhs_mod_remove(struct usbhs_priv *priv)
162{
163	usbhs_mod_host_remove(priv);
164	usbhs_mod_gadget_remove(priv);
165}
166
167/*
168 *		status functions
169 */
170int usbhs_status_get_device_state(struct usbhs_irq_state *irq_state)
171{
172	int state = irq_state->intsts0 & DVSQ_MASK;
173
174	switch (state) {
175	case POWER_STATE:
176	case DEFAULT_STATE:
177	case ADDRESS_STATE:
178	case CONFIGURATION_STATE:
179		return state;
180	}
181
182	return -EIO;
183}
184
185int usbhs_status_get_ctrl_stage(struct usbhs_irq_state *irq_state)
186{
187	/*
188	 * return value
189	 *
190	 * IDLE_SETUP_STAGE
191	 * READ_DATA_STAGE
192	 * READ_STATUS_STAGE
193	 * WRITE_DATA_STAGE
194	 * WRITE_STATUS_STAGE
195	 * NODATA_STATUS_STAGE
196	 * SEQUENCE_ERROR
197	 */
198	return (int)irq_state->intsts0 & CTSQ_MASK;
199}
200
201static int usbhs_status_get_each_irq(struct usbhs_priv *priv,
202				     struct usbhs_irq_state *state)
203{
204	struct usbhs_mod *mod = usbhs_mod_get_current(priv);
205	u16 intenb0, intenb1;
206	unsigned long flags;
207
208	/********************  spin lock ********************/
209	usbhs_lock(priv, flags);
210	state->intsts0 = usbhs_read(priv, INTSTS0);
211	intenb0 = usbhs_read(priv, INTENB0);
212
213	if (usbhs_mod_is_host(priv)) {
214		state->intsts1 = usbhs_read(priv, INTSTS1);
215		intenb1 = usbhs_read(priv, INTENB1);
216	} else {
217		state->intsts1 = intenb1 = 0;
218	}
219
220	/* mask */
221	if (mod) {
222		state->brdysts = usbhs_read(priv, BRDYSTS);
223		state->nrdysts = usbhs_read(priv, NRDYSTS);
224		state->bempsts = usbhs_read(priv, BEMPSTS);
225
226		state->bempsts &= mod->irq_bempsts;
227		state->brdysts &= mod->irq_brdysts;
228	}
229	usbhs_unlock(priv, flags);
230	/********************  spin unlock ******************/
231
232	/*
233	 * Check whether the irq enable registers and the irq status are set
234	 * when IRQF_SHARED is set.
235	 */
236	if (priv->irqflags & IRQF_SHARED) {
237		if (!(intenb0 & state->intsts0) &&
238		    !(intenb1 & state->intsts1) &&
239		    !(state->bempsts) &&
240		    !(state->brdysts))
241			return -EIO;
242	}
243
244	return 0;
245}
246
247/*
248 *		interrupt
249 */
250#define INTSTS0_MAGIC 0xF800 /* acknowledge magical interrupt sources */
251#define INTSTS1_MAGIC 0xA870 /* acknowledge magical interrupt sources */
252static irqreturn_t usbhs_interrupt(int irq, void *data)
253{
254	struct usbhs_priv *priv = data;
255	struct usbhs_irq_state irq_state;
256
257	if (usbhs_status_get_each_irq(priv, &irq_state) < 0)
258		return IRQ_NONE;
259
260	/*
261	 * clear interrupt
262	 *
263	 * The hardware is _very_ picky to clear interrupt bit.
264	 * Especially INTSTS0_MAGIC, INTSTS1_MAGIC value.
265	 *
266	 * see
267	 *	"Operation"
268	 *	 - "Control Transfer (DCP)"
269	 *	   - Function :: VALID bit should 0
270	 */
271	usbhs_write(priv, INTSTS0, ~irq_state.intsts0 & INTSTS0_MAGIC);
272	if (usbhs_mod_is_host(priv))
273		usbhs_write(priv, INTSTS1, ~irq_state.intsts1 & INTSTS1_MAGIC);
274
275	/*
276	 * The driver should not clear the xxxSTS after the line of
277	 * "call irq callback functions" because each "if" statement is
278	 * possible to call the callback function for avoiding any side effects.
279	 */
280	if (irq_state.intsts0 & BRDY)
281		usbhs_write(priv, BRDYSTS, ~irq_state.brdysts);
282	usbhs_write(priv, NRDYSTS, ~irq_state.nrdysts);
283	if (irq_state.intsts0 & BEMP)
284		usbhs_write(priv, BEMPSTS, ~irq_state.bempsts);
285
286	/*
287	 * call irq callback functions
288	 * see also
289	 *	usbhs_irq_setting_update
290	 */
291
292	/* INTSTS0 */
293	if (irq_state.intsts0 & VBINT)
294		usbhs_mod_info_call(priv, irq_vbus, priv, &irq_state);
295
296	if (irq_state.intsts0 & DVST)
297		usbhs_mod_call(priv, irq_dev_state, priv, &irq_state);
298
299	if (irq_state.intsts0 & CTRT)
300		usbhs_mod_call(priv, irq_ctrl_stage, priv, &irq_state);
301
302	if (irq_state.intsts0 & BEMP)
303		usbhs_mod_call(priv, irq_empty, priv, &irq_state);
304
305	if (irq_state.intsts0 & BRDY)
306		usbhs_mod_call(priv, irq_ready, priv, &irq_state);
307
308	if (usbhs_mod_is_host(priv)) {
309		/* INTSTS1 */
310		if (irq_state.intsts1 & ATTCH)
311			usbhs_mod_call(priv, irq_attch, priv, &irq_state);
312
313		if (irq_state.intsts1 & DTCH)
314			usbhs_mod_call(priv, irq_dtch, priv, &irq_state);
315
316		if (irq_state.intsts1 & SIGN)
317			usbhs_mod_call(priv, irq_sign, priv, &irq_state);
318
319		if (irq_state.intsts1 & SACK)
320			usbhs_mod_call(priv, irq_sack, priv, &irq_state);
321	}
322	return IRQ_HANDLED;
323}
324
325void usbhs_irq_callback_update(struct usbhs_priv *priv, struct usbhs_mod *mod)
326{
327	u16 intenb0 = 0;
328	u16 intenb1 = 0;
329	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
330
331	/*
332	 * BEMPENB/BRDYENB are picky.
333	 * below method is required
334	 *
335	 *  - clear  INTSTS0
336	 *  - update BEMPENB/BRDYENB
337	 *  - update INTSTS0
338	 */
339	usbhs_write(priv, INTENB0, 0);
340	if (usbhs_mod_is_host(priv))
341		usbhs_write(priv, INTENB1, 0);
342
343	usbhs_write(priv, BEMPENB, 0);
344	usbhs_write(priv, BRDYENB, 0);
345
346	/*
347	 * see also
348	 *	usbhs_interrupt
349	 */
350
351	/*
352	 * it don't enable DVSE (intenb0) here
353	 * but "mod->irq_dev_state" will be called.
354	 */
355	if (info->irq_vbus)
356		intenb0 |= VBSE;
357
358	if (mod) {
359		/*
360		 * INTSTS0
361		 */
362		if (mod->irq_ctrl_stage)
363			intenb0 |= CTRE;
364
365		if (mod->irq_empty && mod->irq_bempsts) {
366			usbhs_write(priv, BEMPENB, mod->irq_bempsts);
367			intenb0 |= BEMPE;
368		}
369
370		if (mod->irq_ready && mod->irq_brdysts) {
371			usbhs_write(priv, BRDYENB, mod->irq_brdysts);
372			intenb0 |= BRDYE;
373		}
374
375		if (usbhs_mod_is_host(priv)) {
376			/*
377			 * INTSTS1
378			 */
379			if (mod->irq_attch)
380				intenb1 |= ATTCHE;
381
382			if (mod->irq_dtch)
383				intenb1 |= DTCHE;
384
385			if (mod->irq_sign)
386				intenb1 |= SIGNE;
387
388			if (mod->irq_sack)
389				intenb1 |= SACKE;
390		}
391	}
392
393	if (intenb0)
394		usbhs_write(priv, INTENB0, intenb0);
395
396	if (usbhs_mod_is_host(priv) && intenb1)
397		usbhs_write(priv, INTENB1, intenb1);
398}