[deliverable/linux.git] / drivers / usb / renesas_usbhs / mod.c

/*
 * Renesas USB driver
 *
 * Copyright (C) 2011 Renesas Solutions Corp.
 * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 *
 */
#include <linux/interrupt.h>

#include "common.h"
#include "mod.h"

#define usbhs_priv_to_modinfo(priv) (&priv->mod_info)
#define usbhs_mod_info_call(priv, func, param...)	\
({						\
	struct usbhs_mod_info *info;		\
	info = usbhs_priv_to_modinfo(priv);	\
	!info->func ? 0 :			\
	 info->func(param);			\
})

/*
 *		autonomy
 *
 * these functions are used if platform doesn't have external phy.
 *  -> there is no "notify_hotplug" callback from platform
 *  -> call "notify_hotplug" by itself
 *  -> use own interrupt to connect/disconnect
 *  -> it mean module clock is always ON
 *             ~~~~~~~~~~~~~~~~~~~~~~~~~
 */
static int usbhsm_autonomy_get_vbus(struct platform_device *pdev)
{
	struct usbhs_priv *priv = usbhs_pdev_to_priv(pdev);

	return  VBSTS & usbhs_read(priv, INTSTS0);
}

static int usbhsm_autonomy_irq_vbus(struct usbhs_priv *priv,
				    struct usbhs_irq_state *irq_state)
{
	struct platform_device *pdev = usbhs_priv_to_pdev(priv);

	renesas_usbhs_call_notify_hotplug(pdev);

	return 0;
}

void usbhs_mod_autonomy_mode(struct usbhs_priv *priv)
{
	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);

	info->irq_vbus		= usbhsm_autonomy_irq_vbus;
	priv->pfunc.get_vbus	= usbhsm_autonomy_get_vbus;

	usbhs_irq_callback_update(priv, NULL);
}

/*
 *		host / gadget functions
 *
 * renesas_usbhs host/gadget can register itself by below functions.
 * these functions are called when probe
 *
 */
void usbhs_mod_register(struct usbhs_priv *priv, struct usbhs_mod *mod, int id)
{
	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);

	info->mod[id]	= mod;
	mod->priv	= priv;
}

struct usbhs_mod *usbhs_mod_get(struct usbhs_priv *priv, int id)
{
	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
	struct usbhs_mod *ret = NULL;

	switch (id) {
	case USBHS_HOST:
	case USBHS_GADGET:
		ret = info->mod[id];
		break;
	}

	return ret;
}

int usbhs_mod_is_host(struct usbhs_priv *priv)
{
	struct usbhs_mod *mod = usbhs_mod_get_current(priv);
	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);

	if (!mod)
		return -EINVAL;

	return info->mod[USBHS_HOST] == mod;
}

struct usbhs_mod *usbhs_mod_get_current(struct usbhs_priv *priv)
{
	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);

	return info->curt;
}

int usbhs_mod_change(struct usbhs_priv *priv, int id)
{
	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
	struct usbhs_mod *mod = NULL;
	int ret = 0;

	/* id < 0 mean no current */
	switch (id) {
	case USBHS_HOST:
	case USBHS_GADGET:
		mod = info->mod[id];
		break;
	default:
		ret = -EINVAL;
	}
	info->curt = mod;

	return ret;
}

static irqreturn_t usbhs_interrupt(int irq, void *data);
int usbhs_mod_probe(struct usbhs_priv *priv)
{
	struct device *dev = usbhs_priv_to_dev(priv);
	int ret;

	/*
	 * install host/gadget driver
	 */
	ret = usbhs_mod_host_probe(priv);
	if (ret < 0)
		return ret;

	ret = usbhs_mod_gadget_probe(priv);
	if (ret < 0)
		goto mod_init_host_err;

	/* irq settings */
	ret = devm_request_irq(dev, priv->irq, usbhs_interrupt,
			  priv->irqflags, dev_name(dev), priv);
	if (ret) {
		dev_err(dev, "irq request err\n");
		goto mod_init_gadget_err;
	}

	return ret;

mod_init_gadget_err:
	usbhs_mod_gadget_remove(priv);
mod_init_host_err:
	usbhs_mod_host_remove(priv);

	return ret;
}

void usbhs_mod_remove(struct usbhs_priv *priv)
{
	usbhs_mod_host_remove(priv);
	usbhs_mod_gadget_remove(priv);
}

/*
 *		status functions
 */
int usbhs_status_get_device_state(struct usbhs_irq_state *irq_state)
{
	int state = irq_state->intsts0 & DVSQ_MASK;

	switch (state) {
	case POWER_STATE:
	case DEFAULT_STATE:
	case ADDRESS_STATE:
	case CONFIGURATION_STATE:
		return state;
	}

	return -EIO;
}

int usbhs_status_get_ctrl_stage(struct usbhs_irq_state *irq_state)
{
	/*
	 * return value
	 *
	 * IDLE_SETUP_STAGE
	 * READ_DATA_STAGE
	 * READ_STATUS_STAGE
	 * WRITE_DATA_STAGE
	 * WRITE_STATUS_STAGE
	 * NODATA_STATUS_STAGE
	 * SEQUENCE_ERROR
	 */
	return (int)irq_state->intsts0 & CTSQ_MASK;
}

static int usbhs_status_get_each_irq(struct usbhs_priv *priv,
				     struct usbhs_irq_state *state)
{
	struct usbhs_mod *mod = usbhs_mod_get_current(priv);
	u16 intenb0, intenb1;
	unsigned long flags;

	/********************  spin lock ********************/
	usbhs_lock(priv, flags);
	state->intsts0 = usbhs_read(priv, INTSTS0);
	intenb0 = usbhs_read(priv, INTENB0);

	if (usbhs_mod_is_host(priv)) {
		state->intsts1 = usbhs_read(priv, INTSTS1);
		intenb1 = usbhs_read(priv, INTENB1);
	} else {
		state->intsts1 = intenb1 = 0;
	}

	/* mask */
	if (mod) {
		state->brdysts = usbhs_read(priv, BRDYSTS);
		state->nrdysts = usbhs_read(priv, NRDYSTS);
		state->bempsts = usbhs_read(priv, BEMPSTS);

		state->bempsts &= mod->irq_bempsts;
		state->brdysts &= mod->irq_brdysts;
	}
	usbhs_unlock(priv, flags);
	/********************  spin unlock ******************/

	/*
	 * Check whether the irq enable registers and the irq status are set
	 * when IRQF_SHARED is set.
	 */
	if (priv->irqflags & IRQF_SHARED) {
		if (!(intenb0 & state->intsts0) &&
		    !(intenb1 & state->intsts1) &&
		    !(state->bempsts) &&
		    !(state->brdysts))
			return -EIO;
	}

	return 0;
}

/*
 *		interrupt
 */
#define INTSTS0_MAGIC 0xF800 /* acknowledge magical interrupt sources */
#define INTSTS1_MAGIC 0xA870 /* acknowledge magical interrupt sources */
static irqreturn_t usbhs_interrupt(int irq, void *data)
{
	struct usbhs_priv *priv = data;
	struct usbhs_irq_state irq_state;

	if (usbhs_status_get_each_irq(priv, &irq_state) < 0)
		return IRQ_NONE;

	/*
	 * clear interrupt
	 *
	 * The hardware is _very_ picky to clear interrupt bit.
	 * Especially INTSTS0_MAGIC, INTSTS1_MAGIC value.
	 *
	 * see
	 *	"Operation"
	 *	 - "Control Transfer (DCP)"
	 *	   - Function :: VALID bit should 0
	 */
	usbhs_write(priv, INTSTS0, ~irq_state.intsts0 & INTSTS0_MAGIC);
	if (usbhs_mod_is_host(priv))
		usbhs_write(priv, INTSTS1, ~irq_state.intsts1 & INTSTS1_MAGIC);

	/*
	 * The driver should not clear the xxxSTS after the line of
	 * "call irq callback functions" because each "if" statement is
	 * possible to call the callback function for avoiding any side effects.
	 */
	if (irq_state.intsts0 & BRDY)
		usbhs_write(priv, BRDYSTS, ~irq_state.brdysts);
	usbhs_write(priv, NRDYSTS, ~irq_state.nrdysts);
	if (irq_state.intsts0 & BEMP)
		usbhs_write(priv, BEMPSTS, ~irq_state.bempsts);

	/*
	 * call irq callback functions
	 * see also
	 *	usbhs_irq_setting_update
	 */

	/* INTSTS0 */
	if (irq_state.intsts0 & VBINT)
		usbhs_mod_info_call(priv, irq_vbus, priv, &irq_state);

	if (irq_state.intsts0 & DVST)
		usbhs_mod_call(priv, irq_dev_state, priv, &irq_state);

	if (irq_state.intsts0 & CTRT)
		usbhs_mod_call(priv, irq_ctrl_stage, priv, &irq_state);

	if (irq_state.intsts0 & BEMP)
		usbhs_mod_call(priv, irq_empty, priv, &irq_state);

	if (irq_state.intsts0 & BRDY)
		usbhs_mod_call(priv, irq_ready, priv, &irq_state);

	if (usbhs_mod_is_host(priv)) {
		/* INTSTS1 */
		if (irq_state.intsts1 & ATTCH)
			usbhs_mod_call(priv, irq_attch, priv, &irq_state);

		if (irq_state.intsts1 & DTCH)
			usbhs_mod_call(priv, irq_dtch, priv, &irq_state);

		if (irq_state.intsts1 & SIGN)
			usbhs_mod_call(priv, irq_sign, priv, &irq_state);

		if (irq_state.intsts1 & SACK)
			usbhs_mod_call(priv, irq_sack, priv, &irq_state);
	}
	return IRQ_HANDLED;
}

void usbhs_irq_callback_update(struct usbhs_priv *priv, struct usbhs_mod *mod)
{
	u16 intenb0 = 0;
	u16 intenb1 = 0;
	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);

	/*
	 * BEMPENB/BRDYENB are picky.
	 * below method is required
	 *
	 *  - clear  INTSTS0
	 *  - update BEMPENB/BRDYENB
	 *  - update INTSTS0
	 */
	usbhs_write(priv, INTENB0, 0);
	if (usbhs_mod_is_host(priv))
		usbhs_write(priv, INTENB1, 0);

	usbhs_write(priv, BEMPENB, 0);
	usbhs_write(priv, BRDYENB, 0);

	/*
	 * see also
	 *	usbhs_interrupt
	 */

	/*
	 * it don't enable DVSE (intenb0) here
	 * but "mod->irq_dev_state" will be called.
	 */
	if (info->irq_vbus)
		intenb0 |= VBSE;

	if (mod) {
		/*
		 * INTSTS0
		 */
		if (mod->irq_ctrl_stage)
			intenb0 |= CTRE;

		if (mod->irq_empty && mod->irq_bempsts) {
			usbhs_write(priv, BEMPENB, mod->irq_bempsts);
			intenb0 |= BEMPE;
		}

		if (mod->irq_ready && mod->irq_brdysts) {
			usbhs_write(priv, BRDYENB, mod->irq_brdysts);
			intenb0 |= BRDYE;
		}

		if (usbhs_mod_is_host(priv)) {
			/*
			 * INTSTS1
			 */
			if (mod->irq_attch)
				intenb1 |= ATTCHE;

			if (mod->irq_dtch)
				intenb1 |= DTCHE;

			if (mod->irq_sign)
				intenb1 |= SIGNE;

			if (mod->irq_sack)
				intenb1 |= SACKE;
		}
	}

	if (intenb0)
		usbhs_write(priv, INTENB0, intenb0);

	if (usbhs_mod_is_host(priv) && intenb1)
		usbhs_write(priv, INTENB1, intenb1);
}
Commit	Line	Data
f1407d5c KM	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
cc502bb7 PB	19	#include "common.h"
cc502bb7 PB	20	#include "mod.h"
f1407d5c KM	21
f1407d5c KM	22	#define usbhs_priv_to_modinfo(priv) (&priv->mod_info)
b002ff6e KM	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	*/
	41	static 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
	48	static 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
b4fcea2a KM	53	renesas_usbhs_call_notify_hotplug(pdev);
	54
	55	return 0;
b002ff6e KM	56	}
	57
	58	void 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;
48298206	63	priv->pfunc.get_vbus = usbhsm_autonomy_get_vbus;
b002ff6e KM	64
	65	usbhs_irq_callback_update(priv, NULL);
	66	}
f1407d5c KM	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	*/
	75	void 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
	83	struct 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
0deb3e77	98	int usbhs_mod_is_host(struct usbhs_priv *priv)
f1407d5c	99	{
0deb3e77	100	struct usbhs_mod *mod = usbhs_mod_get_current(priv);
f1407d5c KM	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
	109	struct 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
	116	int 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
	136	static irqreturn_t usbhs_interrupt(int irq, void *data);
	137	int usbhs_mod_probe(struct usbhs_priv *priv)
	138	{
	139	struct device *dev = usbhs_priv_to_dev(priv);
	140	int ret;
	141
2f98382d KM	142	/*
	143	* install host/gadget driver
	144	*/
034d7c13	145	ret = usbhs_mod_host_probe(priv);
2f98382d KM	146	if (ret < 0)
	147	return ret;
	148
034d7c13 KM	149	ret = usbhs_mod_gadget_probe(priv);
	150	if (ret < 0)
	151	goto mod_init_host_err;
	152
f1407d5c	153	/* irq settings */
797b4e14	154	ret = devm_request_irq(dev, priv->irq, usbhs_interrupt,
53069af3	155	priv->irqflags, dev_name(dev), priv);
2f98382d	156	if (ret) {
f1407d5c	157	dev_err(dev, "irq request err\n");
2f98382d KM	158	goto mod_init_gadget_err;
	159	}
	160
	161	return ret;
	162
	163	mod_init_gadget_err:
	164	usbhs_mod_gadget_remove(priv);
034d7c13 KM	165	mod_init_host_err:
034d7c13 KM	166	usbhs_mod_host_remove(priv);
f1407d5c KM	167
	168	return ret;
	169	}
	170
	171	void usbhs_mod_remove(struct usbhs_priv *priv)
	172	{
034d7c13	173	usbhs_mod_host_remove(priv);
2f98382d	174	usbhs_mod_gadget_remove(priv);
f1407d5c KM	175	}
	176
	177	/*
	178	* status functions
	179	*/
f1407d5c KM	180	int 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
	195	int 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
697d5c00 SY	211	static int usbhs_status_get_each_irq(struct usbhs_priv *priv,
697d5c00 SY	212	struct usbhs_irq_state *state)
f1407d5c KM	213	{
f1407d5c KM	214	struct usbhs_mod *mod = usbhs_mod_get_current(priv);
697d5c00	215	u16 intenb0, intenb1;
c4d8199b	216	unsigned long flags;
f1407d5c	217
c4d8199b YS	218	/****************** spin lock ******************/
c4d8199b YS	219	usbhs_lock(priv, flags);
f1407d5c	220	state->intsts0 = usbhs_read(priv, INTSTS0);
697d5c00	221	intenb0 = usbhs_read(priv, INTENB0);
88a25e02 NI	222
	223	if (usbhs_mod_is_host(priv)) {
	224	state->intsts1 = usbhs_read(priv, INTSTS1);
	225	intenb1 = usbhs_read(priv, INTENB1);
672bfdaa AB	226	} else {
672bfdaa AB	227	state->intsts1 = intenb1 = 0;
88a25e02	228	}
697d5c00	229
f1407d5c	230	/* mask */
5ea68d54 KM	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	}
c4d8199b YS	239	usbhs_unlock(priv, flags);
c4d8199b YS	240	/****************** spin unlock ****************/
697d5c00 SY	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;
f1407d5c KM	255	}
	256
	257	/*
	258	* interrupt
	259	*/
	260	#define INTSTS0_MAGIC 0xF800 /* acknowledge magical interrupt sources */
	261	#define INTSTS1_MAGIC 0xA870 /* acknowledge magical interrupt sources */
	262	static irqreturn_t usbhs_interrupt(int irq, void *data)
	263	{
	264	struct usbhs_priv *priv = data;
	265	struct usbhs_irq_state irq_state;
	266
697d5c00 SY	267	if (usbhs_status_get_each_irq(priv, &irq_state) < 0)
697d5c00 SY	268	return IRQ_NONE;
f1407d5c KM	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);
88a25e02 NI	282	if (usbhs_mod_is_host(priv))
88a25e02 NI	283	usbhs_write(priv, INTSTS1, ~irq_state.intsts1 & INTSTS1_MAGIC);
f1407d5c	284
519d8bd4 YS	285	/*
	286	* The driver should not clear the xxxSTS after the line of
	287	* "call irq callback functions" because each "if" statement is
	288	* possible to call the callback function for avoiding any side effects.
	289	*/
	290	if (irq_state.intsts0 & BRDY)
	291	usbhs_write(priv, BRDYSTS, ~irq_state.brdysts);
d5c6a1e0	292	usbhs_write(priv, NRDYSTS, ~irq_state.nrdysts);
519d8bd4 YS	293	if (irq_state.intsts0 & BEMP)
519d8bd4 YS	294	usbhs_write(priv, BEMPSTS, ~irq_state.bempsts);
f1407d5c KM	295
	296	/*
	297	* call irq callback functions
	298	* see also
	299	* usbhs_irq_setting_update
	300	*/
89c1d2e7 KM	301
89c1d2e7 KM	302	/* INTSTS0 */
b002ff6e KM	303	if (irq_state.intsts0 & VBINT)
	304	usbhs_mod_info_call(priv, irq_vbus, priv, &irq_state);
	305
f1407d5c KM	306	if (irq_state.intsts0 & DVST)
	307	usbhs_mod_call(priv, irq_dev_state, priv, &irq_state);
	308
	309	if (irq_state.intsts0 & CTRT)
	310	usbhs_mod_call(priv, irq_ctrl_stage, priv, &irq_state);
	311
	312	if (irq_state.intsts0 & BEMP)
	313	usbhs_mod_call(priv, irq_empty, priv, &irq_state);
	314
	315	if (irq_state.intsts0 & BRDY)
	316	usbhs_mod_call(priv, irq_ready, priv, &irq_state);
	317
88a25e02 NI	318	if (usbhs_mod_is_host(priv)) {
	319	/* INTSTS1 */
	320	if (irq_state.intsts1 & ATTCH)
	321	usbhs_mod_call(priv, irq_attch, priv, &irq_state);
89c1d2e7	322
88a25e02 NI	323	if (irq_state.intsts1 & DTCH)
88a25e02 NI	324	usbhs_mod_call(priv, irq_dtch, priv, &irq_state);
89c1d2e7	325
88a25e02 NI	326	if (irq_state.intsts1 & SIGN)
88a25e02 NI	327	usbhs_mod_call(priv, irq_sign, priv, &irq_state);
89c1d2e7	328
88a25e02 NI	329	if (irq_state.intsts1 & SACK)
	330	usbhs_mod_call(priv, irq_sack, priv, &irq_state);
	331	}
f1407d5c KM	332	return IRQ_HANDLED;
	333	}
	334
	335	void usbhs_irq_callback_update(struct usbhs_priv priv, struct usbhs_mod mod)
	336	{
	337	u16 intenb0 = 0;
89c1d2e7	338	u16 intenb1 = 0;
b002ff6e	339	struct usbhs_mod_info *info = usbhs_priv_to_modinfo(priv);
f1407d5c	340
651f5e49 KM	341	/*
	342	* BEMPENB/BRDYENB are picky.
	343	* below method is required
	344	*
	345	* - clear INTSTS0
	346	* - update BEMPENB/BRDYENB
	347	* - update INTSTS0
	348	*/
f1407d5c	349	usbhs_write(priv, INTENB0, 0);
88a25e02 NI	350	if (usbhs_mod_is_host(priv))
88a25e02 NI	351	usbhs_write(priv, INTENB1, 0);
f1407d5c KM	352
	353	usbhs_write(priv, BEMPENB, 0);
	354	usbhs_write(priv, BRDYENB, 0);
	355
	356	/*
	357	* see also
	358	* usbhs_interrupt
	359	*/
	360
	361	/*
	362	* it don't enable DVSE (intenb0) here
	363	* but "mod->irq_dev_state" will be called.
	364	*/
b002ff6e KM	365	if (info->irq_vbus)
b002ff6e KM	366	intenb0 \|= VBSE;
f1407d5c	367
5ea68d54	368	if (mod) {
89c1d2e7 KM	369	/*
	370	* INTSTS0
	371	*/
5ea68d54 KM	372	if (mod->irq_ctrl_stage)
5ea68d54 KM	373	intenb0 \|= CTRE;
f1407d5c	374
5ea68d54 KM	375	if (mod->irq_empty && mod->irq_bempsts) {
	376	usbhs_write(priv, BEMPENB, mod->irq_bempsts);
	377	intenb0 \|= BEMPE;
	378	}
f1407d5c	379
5ea68d54 KM	380	if (mod->irq_ready && mod->irq_brdysts) {
	381	usbhs_write(priv, BRDYENB, mod->irq_brdysts);
	382	intenb0 \|= BRDYE;
	383	}
89c1d2e7	384
88a25e02 NI	385	if (usbhs_mod_is_host(priv)) {
	386	/*
	387	* INTSTS1
	388	*/
	389	if (mod->irq_attch)
	390	intenb1 \|= ATTCHE;
89c1d2e7	391
88a25e02 NI	392	if (mod->irq_dtch)
88a25e02 NI	393	intenb1 \|= DTCHE;
89c1d2e7	394
88a25e02 NI	395	if (mod->irq_sign)
88a25e02 NI	396	intenb1 \|= SIGNE;
89c1d2e7	397
88a25e02 NI	398	if (mod->irq_sack)
	399	intenb1 \|= SACKE;
	400	}
f1407d5c KM	401	}
f1407d5c KM	402
651f5e49 KM	403	if (intenb0)
651f5e49 KM	404	usbhs_write(priv, INTENB0, intenb0);
89c1d2e7	405
88a25e02	406	if (usbhs_mod_is_host(priv) && intenb1)
89c1d2e7	407	usbhs_write(priv, INTENB1, intenb1);
f1407d5c	408	}