隱龍窟


/**
  * ci_otg_work - perform otg (vbus/id) event handle
  * @work: work struct
  */
 static void ci_otg_work(struct work_struct *work)
 {
  struct ci_hdrc *ci = container_of(work, struct ci_hdrc, work);

  if (ci_otg_is_fsm_mode(ci) && !ci_otg_fsm_work(ci)) {
   enable_irq(ci->irq);
   return;
  }

  if (ci->id_event) {
   ci->id_event = false;
   ci_handle_id_switch(ci);
  } else if (ci->b_sess_valid_event) {
   ci->b_sess_valid_event = false;
   ci_handle_vbus_change(ci);
  } else
   dev_err(ci->dev, "unexpected event occurs at %s\n", __func__);

  enable_irq(ci->irq);
 }

 #define CI_VBUS_STABLE_TIMEOUT_MS 5000
 static void ci_handle_id_switch(struct ci_hdrc *ci)
 {
  enum ci_role role = ci_otg_role(ci);

  if (role != ci->role) {
   dev_dbg(ci->dev, "switching from %s to %s\n",
    ci_role(ci)->name, ci->roles[role]->name);

   ci_role_stop(ci);
   /* wait vbus lower than OTGSC_BSV */
   hw_wait_reg(ci, OP_OTGSC, OTGSC_BSV, 0,
     CI_VBUS_STABLE_TIMEOUT_MS);
   ci_role_start(ci, role);
  }
 }
/**
  * ci_otg_role - pick role based on ID pin state
  * @ci: the controller
  */
 enum ci_role ci_otg_role(struct ci_hdrc *ci)
 {
  enum ci_role role = hw_read_otgsc(ci, OTGSC_ID)
   ? CI_ROLE_GADGET
   : CI_ROLE_HOST;

  return role;
 }
/**
	* ci_otg_work - perform otg (vbus/id) event handle
	* @work: work struct
	*/
	static void ci_otg_work(struct work_struct *work)
	{
	struct ci_hdrc *ci = container_of(work, struct ci_hdrc, work);

	if (ci_otg_is_fsm_mode(ci) && !ci_otg_fsm_work(ci)) {
	enable_irq(ci->irq);
	return;
	}

	if (ci->id_event) {
	ci->id_event = false;
	ci_handle_id_switch(ci);
	} else if (ci->b_sess_valid_event) {
	ci->b_sess_valid_event = false;
	ci_handle_vbus_change(ci);
	} else
	dev_err(ci->dev, "unexpected event occurs at %s\n", __func__);

	enable_irq(ci->irq);
	}

	#define CI_VBUS_STABLE_TIMEOUT_MS 5000
	static void ci_handle_id_switch(struct ci_hdrc *ci)
	{
	enum ci_role role = ci_otg_role(ci);

	if (role != ci->role) {
	dev_dbg(ci->dev, "switching from %s to %s\n",
	ci_role(ci)->name, ci->roles[role]->name);

	ci_role_stop(ci);
	/* wait vbus lower than OTGSC_BSV */
	hw_wait_reg(ci, OP_OTGSC, OTGSC_BSV, 0,
	CI_VBUS_STABLE_TIMEOUT_MS);
	ci_role_start(ci, role);
	}
	}
/**
	* ci_otg_role - pick role based on ID pin state
	* @ci: the controller
	*/
	enum ci_role ci_otg_role(struct ci_hdrc *ci)
	{
	enum ci_role role = hw_read_otgsc(ci, OTGSC_ID)
	? CI_ROLE_GADGET
	: CI_ROLE_HOST;

	return role;
	}