On Thu, Feb 27, 2014 at 07:38:26AM +0800, Li Jun wrote:
> This patch adds OTG fsm timers initialization, which use controller's 1ms
> interrupt as timeout counter, also adds some local timers which are not
> in otg_fsm_timer list.
> 
> Signed-off-by: Li Jun <b47...@freescale.com>
> ---
>  drivers/usb/chipidea/bits.h    |    1 +
>  drivers/usb/chipidea/otg_fsm.c |  190 
> ++++++++++++++++++++++++++++++++++++++++
>  drivers/usb/chipidea/otg_fsm.h |   65 ++++++++++++++
>  3 files changed, 256 insertions(+)
> 
> diff --git a/drivers/usb/chipidea/bits.h b/drivers/usb/chipidea/bits.h
> index c42eb35..302cde7 100644
> --- a/drivers/usb/chipidea/bits.h
> +++ b/drivers/usb/chipidea/bits.h
> @@ -83,6 +83,7 @@
>  #define OTGSC_VC           BIT(1)
>  #define OTGSC_IDPU         BIT(5)
>  #define OTGSC_HADP         BIT(6)
> +#define OTGSC_HABA         BIT(7)
>  #define OTGSC_ID           BIT(8)
>  #define OTGSC_AVV          BIT(9)
>  #define OTGSC_ASV          BIT(10)
> diff --git a/drivers/usb/chipidea/otg_fsm.c b/drivers/usb/chipidea/otg_fsm.c
> index aa24466..f9e536b 100644
> --- a/drivers/usb/chipidea/otg_fsm.c
> +++ b/drivers/usb/chipidea/otg_fsm.c
> @@ -25,6 +25,22 @@
>  #include "otg.h"
>  #include "otg_fsm.h"
>  
> +static struct ci_otg_fsm_timer *otg_timer_initializer
> +(struct ci_hdrc *ci, void (*function)(void *, unsigned long),
> +                     unsigned long expires, unsigned long data)
> +{
> +     struct ci_otg_fsm_timer *timer;
> +
> +     timer = devm_kzalloc(ci->dev, sizeof(struct ci_otg_fsm_timer),
> +                                                             GFP_KERNEL);
> +     if (!timer)
> +             return NULL;
> +     timer->function = function;
> +     timer->expires = expires;
> +     timer->data = data;
> +     return timer;
> +}
> +
>  /* Add timer to active timer list */
>  static void ci_otg_add_timer(struct ci_hdrc *ci, enum ci_otg_fsm_timer_index 
> t)
>  {
> @@ -75,6 +91,163 @@ static void ci_otg_del_timer(struct ci_hdrc *ci, enum 
> ci_otg_fsm_timer_index t)
>               ci_disable_otg_interrupt(ci, OTGSC_1MSIE);
>  }
>  
> +/*
> + * Reduce timer count by 1, and find timeout conditions.
> + * Called by otg 1ms timer interrupt
> + */
> +static int ci_otg_tick_timer(struct ci_hdrc *ci)
> +{
> +     struct ci_otg_fsm_timer *tmp_timer, *del_tmp;
> +     struct list_head *active_timers = &ci->fsm_timer->active_timers;
> +     int expired = 0;
> +
> +     list_for_each_entry_safe(tmp_timer, del_tmp, active_timers, list) {
> +             tmp_timer->count--;
> +             /* check if timer expires */
> +             if (!tmp_timer->count) {
> +                     list_del(&tmp_timer->list);
> +                     tmp_timer->function(ci, tmp_timer->data);
> +                     expired = 1;
> +             }
> +     }
> +
> +     /* disable 1ms irq if there is no any timer active */
> +     if ((expired == 1) && list_empty(active_timers))
> +             ci_disable_otg_interrupt(ci, OTGSC_1MSIE);
> +
> +     return expired;
> +}

The above function is much like ci_otg_del_timer at your 7th patch,
is it possible to use the same API?

> +
> +/* The timeout callback function to set time out bit */
> +static void set_tmout(void *ptr, unsigned long indicator)
> +{
> +     *(int *)indicator = 1;
> +}
> +
> +static void set_tmout_and_fsm(void *ptr, unsigned long indicator)
> +{
> +     struct ci_hdrc *ci = (struct ci_hdrc *)ptr;
> +
> +     set_tmout(ci, indicator);
> +
> +     /* trans from a_wait_bcon to a_wait_vfall */
> +     disable_irq_nosync(ci->irq);
> +     queue_work(ci->wq, &ci->work);
> +}
> +
> +static void b_ssend_srp_tmout_func(void *ptr, unsigned long indicator)
> +{
> +     struct ci_hdrc *ci = (struct ci_hdrc *)ptr;
> +     set_tmout(ci, indicator);
> +
> +     /* only vbus fall below B_sess_vld in b_idle state */
> +     if (ci->transceiver->state == OTG_STATE_B_IDLE) {
> +             disable_irq_nosync(ci->irq);
> +             queue_work(ci->wq, &ci->work);
> +     }
> +}
> +
> +static void b_sess_vld_tmout_func(void *ptr, unsigned long indicator)
> +{
> +     struct ci_hdrc *ci = (struct ci_hdrc *)ptr;
> +
> +     /* Check if A detached */
> +     if (!(hw_read(ci, OP_OTGSC, OTGSC_BSV))) {
> +             ci->fsm->b_sess_vld = 0;
> +             ci_otg_add_timer(ci, B_SSEND_SRP);
> +             disable_irq_nosync(ci->irq);
> +             queue_work(ci->wq, &ci->work);
> +     }
> +}
> +
> +static void b_data_pulse_end(void *ptr, unsigned long indicator)
> +{
> +     struct ci_hdrc *ci = (struct ci_hdrc *)ptr;
> +
> +     ci->fsm->b_srp_done = 1;
> +     ci->fsm->b_bus_req = 0;
> +     if (ci->fsm->power_up)
> +             ci->fsm->power_up = 0;
> +
> +     hw_write(ci, OP_OTGSC, OTGSC_INT_STATUS_BITS | OTGSC_HABA, 0);
> +
> +     disable_irq_nosync(ci->irq);
> +     queue_work(ci->wq, &ci->work);
> +}
> +
> +/* Initialize timers */
> +static int ci_otg_init_timers(struct ci_hdrc *ci)
> +{
> +     struct otg_fsm *fsm = ci->fsm;
> +
> +     /* FSM used timers */
> +     ci->fsm_timer->timer_list[A_WAIT_VRISE] =
> +             otg_timer_initializer(ci, &set_tmout, TA_WAIT_VRISE,
> +                     (unsigned long)&fsm->a_wait_vrise_tmout);
> +     if (ci->fsm_timer->timer_list[A_WAIT_VRISE] == NULL)
> +             return -ENOMEM;
> +
> +     ci->fsm_timer->timer_list[A_WAIT_VFALL] =
> +             otg_timer_initializer(ci, &set_tmout_and_fsm, TA_WAIT_VFALL,
> +                             (unsigned long)&fsm->a_wait_vfall_tmout);
> +     if (ci->fsm_timer->timer_list[A_WAIT_VFALL] == NULL)
> +             return -ENOMEM;
> +
> +     ci->fsm_timer->timer_list[A_WAIT_BCON] =
> +             otg_timer_initializer(ci, &set_tmout_and_fsm, TA_WAIT_BCON,
> +                             (unsigned long)&fsm->a_wait_bcon_tmout);
> +     if (ci->fsm_timer->timer_list[A_WAIT_BCON] == NULL)
> +             return -ENOMEM;
> +
> +     ci->fsm_timer->timer_list[A_AIDL_BDIS] =
> +             otg_timer_initializer(ci, &set_tmout_and_fsm, TA_AIDL_BDIS,
> +                             (unsigned long)&fsm->a_aidl_bdis_tmout);
> +     if (ci->fsm_timer->timer_list[A_AIDL_BDIS] == NULL)
> +             return -ENOMEM;
> +
> +     ci->fsm_timer->timer_list[A_BIDL_ADIS] =
> +             otg_timer_initializer(ci, &set_tmout_and_fsm, TA_BIDL_ADIS,
> +                             (unsigned long)&fsm->a_bidl_adis_tmout);
> +     if (ci->fsm_timer->timer_list[A_BIDL_ADIS] == NULL)
> +             return -ENOMEM;
> +
> +     ci->fsm_timer->timer_list[B_ASE0_BRST] =
> +             otg_timer_initializer(ci, &set_tmout, TB_ASE0_BRST,
> +                     (unsigned long)&fsm->b_ase0_brst_tmout);
> +     if (ci->fsm_timer->timer_list[B_ASE0_BRST] == NULL)
> +             return -ENOMEM;
> +
> +     ci->fsm_timer->timer_list[B_SE0_SRP] =
> +             otg_timer_initializer(ci, &set_tmout_and_fsm, TB_SE0_SRP,
> +                                     (unsigned long)&fsm->b_se0_srp);
> +     if (ci->fsm_timer->timer_list[B_SE0_SRP] == NULL)
> +             return -ENOMEM;
> +
> +     ci->fsm_timer->timer_list[B_SSEND_SRP] =
> +             otg_timer_initializer(ci, &b_ssend_srp_tmout_func, TB_SSEND_SRP,
> +                                     (unsigned long)&fsm->b_ssend_srp);
> +     if (ci->fsm_timer->timer_list[B_SSEND_SRP] == NULL)
> +             return -ENOMEM;
> +
> +     ci->fsm_timer->timer_list[B_SRP_FAIL] =
> +             otg_timer_initializer(ci, &set_tmout, TB_SRP_FAIL,
> +                             (unsigned long)&fsm->b_srp_done);
> +     if (ci->fsm_timer->timer_list[B_SRP_FAIL] == NULL)
> +             return -ENOMEM;
> +
> +     ci->fsm_timer->timer_list[B_DATA_PLS] =
> +             otg_timer_initializer(ci, &b_data_pulse_end, TB_DATA_PLS, 0);
> +     if (ci->fsm_timer->timer_list[B_DATA_PLS] == NULL)
> +             return -ENOMEM;
> +
> +     ci->fsm_timer->timer_list[B_SESS_VLD] = otg_timer_initializer(ci,
> +                                     &b_sess_vld_tmout_func, TB_SESS_VLD, 0);
> +     if (ci->fsm_timer->timer_list[B_SESS_VLD] == NULL)
> +             return -ENOMEM;
> +
> +     return 0;
> +}
> +
>  /* -------------------------------------------------------------*/
>  /* Operations that will be called from OTG Finite State Machine */
>  /* -------------------------------------------------------------*/
> @@ -256,6 +429,8 @@ static struct otg_fsm_ops ci_otg_ops = {
>  
>  int ci_hdrc_otg_fsm_init(struct ci_hdrc *ci)
>  {
> +     int retval = 0;
> +
>       if (ci->platdata->dr_mode != USB_DR_MODE_OTG)
>               return 0;
>  
> @@ -285,6 +460,21 @@ int ci_hdrc_otg_fsm_init(struct ci_hdrc *ci)
>  
>       mutex_init(&ci->fsm->lock);
>  
> +     ci->fsm_timer = devm_kzalloc(ci->dev,
> +                     sizeof(struct ci_otg_fsm_timer_list), GFP_KERNEL);
> +     if (!ci->fsm_timer) {
> +             dev_err(ci->dev,
> +             "Failed to allocate timer structure for ci hdrc otg!\n");
> +             return -ENOMEM;
> +     }
> +
> +     INIT_LIST_HEAD(&ci->fsm_timer->active_timers);
> +     retval = ci_otg_init_timers(ci);
> +     if (retval) {
> +             dev_err(ci->dev, "Couldn't init OTG timers\n");
> +             return retval;
> +     }
> +
>       /* Enable A vbus valid irq */
>       ci_enable_otg_interrupt(ci, OTGSC_AVVIE);
>  
> diff --git a/drivers/usb/chipidea/otg_fsm.h b/drivers/usb/chipidea/otg_fsm.h
> index 1f85ad3..77b604b 100644
> --- a/drivers/usb/chipidea/otg_fsm.h
> +++ b/drivers/usb/chipidea/otg_fsm.h
> @@ -13,6 +13,71 @@
>  
>  #include <linux/usb/otg-fsm.h>
>  
> +/*
> + *  A-DEVICE timing  constants
> + */
> +
> +/* Wait for VBUS Rise  */
> +#define TA_WAIT_VRISE        (100)   /* a_wait_vrise 100 ms, section: 
> 6.6.5.1 */
> +
> +/* Wait for VBUS Fall  */
> +#define TA_WAIT_VFALL   (1000)  /* a_wait_vfall: Used by A device to wait
> +                              * Vbus to fall below Votg_bus_lkg 7.4.5.2
> +                              * TSSEND_LKG 1 sec */
> +/* Wait for B-Connect */
> +#define TA_WAIT_BCON (10000)  /* a_wait_bcon > 1 sec, section: 6.6.5.2
> +                               * This is only used to get out of
> +                               * OTG_STATE_A_WAIT_BCON state if there was
> +                               * no connection for these many milliseconds
> +                               */
> +
> +/* A-Idle to B-Disconnect */
> +/* It is necessary for this timer to be more than 750 ms because of a bug in 
> OPT
> + * test 5.4 in which B OPT disconnects after 750 ms instead of 75ms as stated
> + * in the test description
> + */
> +#define TA_AIDL_BDIS (5000)  /* a_suspend minimum 200 ms, section: 6.6.5.3 */
> +
> +/* B-Idle to A-Disconnect */
> +#define TA_BIDL_ADIS (500)   /* 3 to 200 ms */
> +
> +/* B-device timing constants */
> +
> +
> +/* Data-Line Pulse Time*/
> +#define TB_DATA_PLS  (10)    /* b_srp_init,continue 5~10ms, section:5.3.3 */
> +#define TB_DATA_PLS_MIN      (5)     /* minimum 5 ms */
> +#define TB_DATA_PLS_MAX      (10)    /* maximum 10 ms */
> +
> +/* SRP Initiate Time  */
> +#define TB_SRP_INIT  (100)   /* b_srp_init,maximum 100 ms, section:5.3.8 */
> +
> +/* SRP Fail Time  */
> +#define TB_SRP_FAIL  (7000)  /* b_srp_init,Fail time 5~30s, section:6.8.2.2*/
> +
> +/* SRP result wait time */
> +#define TB_SRP_WAIT  (60)
> +
> +/* VBus time */
> +#define TB_VBUS_PLS  (30)    /* time to keep vbus pulsing asserted */
> +
> +/* Discharge time */
> +/* This time should be less than 10ms. It varies from system to system. */
> +#define TB_VBUS_DSCHRG       (8)
> +
> +/* A-SE0 to B-Reset  */
> +#define TB_ASE0_BRST (20)    /* b_wait_acon, mini 3.125 ms,section:6.8.2.4 */
> +
> +/* A bus suspend timer before we can switch to b_wait_aconn */
> +#define TB_A_SUSPEND (7)
> +#define TB_BUS_RESUME        (12)
> +
> +/* SE0 Time Before SRP */
> +#define TB_SE0_SRP   (2)     /* b_idle,minimum 2 ms, section:5.3.2 */
> +/* SSEND time before SRP, 1.5 sec min */
> +#define TB_SSEND_SRP    (1500)  /* Table 5-1, Session end to SRP init */
> +#define TB_SESS_VLD     (1000)
> +
>  enum ci_otg_fsm_timer_index {
>       /* CI specific timers, start from the end
>        * of standard and auxiliary OTG timers */
> -- 
> 1.7.9.5
> 
> 

I find some definitions and comments are not correct, for example:
TA_WAIT_BCON is 1.1-30s, and reference section is 5.2.1.
I am using OTG and EH Revision 2.0 version 1.1a specification.

-- 

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

Reply via email to