On Wed, Apr 09, 2014 at 08:34:51AM +0800, Peter Chen wrote: > On Sat, Apr 05, 2014 at 01:37:14PM +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 | 17 ++++++++++ > > drivers/usb/chipidea/otg.c | 1 + > > drivers/usb/chipidea/otg_fsm.c | 68 ++++++++++++++++++++++++++++++++++++++++ > > drivers/usb/chipidea/otg_fsm.h | 29 +++++++++++++++++ > > 5 files changed, 116 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..bd3529f 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 > > @@ -139,6 +140,7 @@ struct hw_bank { > > * @roles: array of supported roles for this controller > > * @role: current role > > * @is_otg: if the device is otg-capable > > + * @fsm: otg finite state machine > > * @work: work for role changing > > * @wq: workqueue thread > > * @qh_pool: allocation pool for queue heads > > @@ -174,6 +176,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; > > > > @@ -319,6 +322,20 @@ static inline u32 hw_test_and_write(struct ci_hdrc *ci, enum ci_hw_regs reg, > > return (val & mask) >> __ffs(mask); > > } > > > > +/** > > + * ci_otg_is_fsm_mode: runtime check if otg controller > > + * is in otg fsm mode. > > + */ > > +static inline bool ci_otg_is_fsm_mode(struct ci_hdrc *ci) > > +{ > > +#ifdef CONFIG_USB_OTG_FSM > > + return ci->is_otg && ci->roles[CI_ROLE_HOST] && > > + ci->roles[CI_ROLE_GADGET]; > > +#else > > + return false; > > +#endif > > +} > > + > > u32 hw_read_intr_enable(struct ci_hdrc *ci); > > > > u32 hw_read_intr_status(struct ci_hdrc *ci); > > diff --git a/drivers/usb/chipidea/otg.c b/drivers/usb/chipidea/otg.c > > index c694340..f978fa9 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. > > diff --git a/drivers/usb/chipidea/otg_fsm.c b/drivers/usb/chipidea/otg_fsm.c > > new file mode 100644 > > index 0000000..eddfe53 > > --- /dev/null > > +++ b/drivers/usb/chipidea/otg_fsm.c > > @@ -0,0 +1,68 @@ > > +/* > > + * 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/hcd.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) > > +{ > > + struct usb_otg *otg; > > + > > + otg = devm_kzalloc(ci->dev, > > + sizeof(struct usb_otg), GFP_KERNEL); > > + if (!otg) { > > + dev_err(ci->dev, > > + "Failed to allocate usb_otg structure for ci hdrc otg!\n"); > > + return -ENOMEM; > > + } > > + > > + otg->phy = ci->transceiver; > > + otg->gadget = &ci->gadget; > > + if (ci->hcd) > > + otg->host = &ci->hcd->self; > > What's the purpose for this? > Since I move fsm init after ci_role_start in this patchset, For case host start happens before this fsm init (power up with ID is 0), so need init otg->host here. Li Jun > > + ci->fsm.otg = otg; > > + ci->transceiver->otg = ci->fsm.otg; > > + ci->fsm.power_up = 1; > > + ci->fsm.id = hw_read_otgsc(ci, OTGSC_ID) ? 1 : 0; > > + 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; > > + } > > + > > + if (ci->role == CI_ROLE_HOST) > > + ci->fsm.protocol = PROTO_HOST; > > + else if (ci->role == CI_ROLE_GADGET) > > + ci->fsm.protocol = PROTO_GADGET; > > + > > + return 0; > > +} > > diff --git a/drivers/usb/chipidea/otg_fsm.h b/drivers/usb/chipidea/otg_fsm.h > > new file mode 100644 > > index 0000000..bf20a85 > > --- /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 inline 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