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 <b47...@freescale.com>
> ---
> 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.
> + 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 majord...@vger.kernel.org
More majordomo info at http://vger.kernel.org/majordomo-info.html
