On Wed, Mar 26, 2014 at 09:51:02AM +0800, Peter Chen wrote: > On Wed, Mar 19, 2014 at 06:01:34PM +0800, Li Jun wrote: > > This patch adds OTG fsm related initialization when do otg init, > > add a seperate file for OTG fsm related utilities. > > > > Signed-off-by: Li Jun <b47624@xxxxxxxxxxxxx> > > --- > > drivers/usb/chipidea/Makefile | 1 + > > drivers/usb/chipidea/ci.h | 2 ++ > > drivers/usb/chipidea/otg.c | 7 +++++ > > drivers/usb/chipidea/otg_fsm.c | 60 ++++++++++++++++++++++++++++++++++++++++ > > drivers/usb/chipidea/otg_fsm.h | 29 +++++++++++++++++++ > > 5 files changed, 99 insertions(+) > > > > diff --git a/drivers/usb/chipidea/Makefile b/drivers/usb/chipidea/Makefile > > index 480bd4d..2f099c7 100644 > > --- a/drivers/usb/chipidea/Makefile > > +++ b/drivers/usb/chipidea/Makefile > > @@ -6,6 +6,7 @@ ci_hdrc-y := core.o otg.o > > ci_hdrc-$(CONFIG_USB_CHIPIDEA_UDC) += udc.o > > ci_hdrc-$(CONFIG_USB_CHIPIDEA_HOST) += host.o > > ci_hdrc-$(CONFIG_USB_CHIPIDEA_DEBUG) += debug.o > > +ci_hdrc-$(CONFIG_USB_OTG_FSM) += otg_fsm.o > > > > # Glue/Bridge layers go here > > > > diff --git a/drivers/usb/chipidea/ci.h b/drivers/usb/chipidea/ci.h > > index 7ae8cb6..4491c43 100644 > > --- a/drivers/usb/chipidea/ci.h > > +++ b/drivers/usb/chipidea/ci.h > > @@ -17,6 +17,7 @@ > > #include <linux/irqreturn.h> > > #include <linux/usb.h> > > #include <linux/usb/gadget.h> > > +#include <linux/usb/otg-fsm.h> > > > > /****************************************************************************** > > * DEFINE > > @@ -174,6 +175,7 @@ struct ci_hdrc { > > struct ci_role_driver *roles[CI_ROLE_END]; > > enum ci_role role; > > bool is_otg; > > + struct otg_fsm fsm; > > struct work_struct work; > > struct workqueue_struct *wq; > > > > diff --git a/drivers/usb/chipidea/otg.c b/drivers/usb/chipidea/otg.c > > index c694340..3082b52 100644 > > --- a/drivers/usb/chipidea/otg.c > > +++ b/drivers/usb/chipidea/otg.c > > @@ -22,6 +22,7 @@ > > #include "ci.h" > > #include "bits.h" > > #include "otg.h" > > +#include "otg_fsm.h" > > > > /** > > * hw_read_otgsc returns otgsc register bits value. > > @@ -109,6 +110,12 @@ static void ci_otg_work(struct work_struct *work) > > */ > > int ci_hdrc_otg_init(struct ci_hdrc *ci) > > { > > + int retval = 0; > > + > > + retval = ci_hdrc_otg_fsm_init(ci); > > You can use int retval = ci_hdrc_otg_fsm_init(ci); directly. > I will change. > > + if (retval) > > + return retval; > > + > > INIT_WORK(&ci->work, ci_otg_work); > > ci->wq = create_singlethread_workqueue("ci_otg"); > > if (!ci->wq) { > > diff --git a/drivers/usb/chipidea/otg_fsm.c b/drivers/usb/chipidea/otg_fsm.c > > new file mode 100644 > > index 0000000..fbe63f0 > > --- /dev/null > > +++ b/drivers/usb/chipidea/otg_fsm.c > > @@ -0,0 +1,60 @@ > > +/* > > + * otg_fsm.c - ChipIdea USB IP core OTG FSM driver > > + * > > + * Copyright (C) 2014 Freescale Semiconductor, Inc. > > + * > > + * Author: Jun Li > > + * > > + * This program is free software; you can redistribute it and/or modify > > + * it under the terms of the GNU General Public License version 2 as > > + * published by the Free Software Foundation. > > + */ > > + > > +/* > > + * This file mainly handles OTG fsm, it includes OTG fsm operations > > + * for HNP and SRP. > > + */ > > + > > +#include <linux/usb/otg.h> > > +#include <linux/usb/gadget.h> > > +#include <linux/usb/chipidea.h> > > + > > +#include "ci.h" > > +#include "bits.h" > > +#include "otg.h" > > +#include "otg_fsm.h" > > + > > +int ci_hdrc_otg_fsm_init(struct ci_hdrc *ci) > > +{ > > + if (ci->platdata->dr_mode != USB_DR_MODE_OTG) > > + return 0; > > + > > + ci->transceiver->otg = devm_kzalloc(ci->dev, > > + sizeof(struct usb_otg), GFP_KERNEL); > > + if (!ci->transceiver->otg) { > > + dev_err(ci->dev, > > + "Failed to allocate usb_otg structure for ci hdrc otg!\n"); > > + return -ENOMEM; > > + } > > + > > + ci->fsm.power_up = 1; > > + ci->fsm.id = hw_read_otgsc(ci, OTGSC_ID); > > + ci->fsm.otg = ci->transceiver->otg; > > + ci->fsm.otg->phy = ci->transceiver; > > + ci->fsm.otg->gadget = &ci->gadget; > > + ci->transceiver->state = OTG_STATE_UNDEFINED; > > + > > + mutex_init(&ci->fsm.lock); > > + > > + /* Enable A vbus valid irq */ > > + hw_write_otgsc(ci, OTGSC_AVVIE, OTGSC_AVVIE); > > + > > + if (ci->fsm.id) { > > + ci->fsm.b_ssend_srp = > > + hw_read_otgsc(ci, OTGSC_BSV) ? 0 : 1; > > + ci->fsm.b_sess_vld = > > + hw_read_otgsc(ci, OTGSC_BSV) ? 1 : 0; > > + } > > + > > + return 0; > > +} > > diff --git a/drivers/usb/chipidea/otg_fsm.h b/drivers/usb/chipidea/otg_fsm.h > > new file mode 100644 > > index 0000000..cf27253 > > --- /dev/null > > +++ b/drivers/usb/chipidea/otg_fsm.h > > @@ -0,0 +1,29 @@ > > +/* > > + * Copyright (C) 2014 Freescale Semiconductor, Inc. > > + * > > + * Author: Jun Li > > + * > > + * This program is free software; you can redistribute it and/or modify > > + * it under the terms of the GNU General Public License version 2 as > > + * published by the Free Software Foundation. > > + */ > > + > > +#ifndef __DRIVERS_USB_CHIPIDEA_OTG_FSM_H > > +#define __DRIVERS_USB_CHIPIDEA_OTG_FSM_H > > + > > +#include <linux/usb/otg-fsm.h> > > + > > +#ifdef CONFIG_USB_OTG_FSM > > + > > +int ci_hdrc_otg_fsm_init(struct ci_hdrc *ci); > > + > > +#else > > + > > +static int ci_hdrc_otg_fsm_init(struct ci_hdrc *ci) > > +{ > > + return 0; > > +} > > + > > +#endif > > + > > +#endif /* __DRIVERS_USB_CHIPIDEA_OTG_FSM_H */ > > -- > > 1.7.9.5 > > > > > > -- > > Best Regards, > Peter Chen > -- To unsubscribe from this list: send the line "unsubscribe linux-usb" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html