^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * OTG Finite State Machine from OTG spec
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2007,2008 Freescale Semiconductor, Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Author: Li Yang <LeoLi@freescale.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * Jerry Huang <Chang-Ming.Huang@freescale.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/usb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/usb/gadget.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/usb/otg.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/usb/otg-fsm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #ifdef VERBOSE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define VDBG(fmt, args...) pr_debug("[%s] " fmt, \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) __func__, ## args)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define VDBG(stuff...) do {} while (0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) /* Change USB protocol when there is a protocol change */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) static int otg_set_protocol(struct otg_fsm *fsm, int protocol)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) if (fsm->protocol != protocol) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) VDBG("Changing role fsm->protocol= %d; new protocol= %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) fsm->protocol, protocol);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) /* stop old protocol */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) if (fsm->protocol == PROTO_HOST)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) ret = otg_start_host(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) else if (fsm->protocol == PROTO_GADGET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) ret = otg_start_gadget(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) /* start new protocol */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) if (protocol == PROTO_HOST)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) ret = otg_start_host(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) else if (protocol == PROTO_GADGET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) ret = otg_start_gadget(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) fsm->protocol = protocol;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) /* Called when leaving a state. Do state clean up jobs here */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) static void otg_leave_state(struct otg_fsm *fsm, enum usb_otg_state old_state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) switch (old_state) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) case OTG_STATE_B_IDLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) otg_del_timer(fsm, B_SE0_SRP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) fsm->b_se0_srp = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) fsm->adp_sns = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) fsm->adp_prb = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) case OTG_STATE_B_SRP_INIT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) fsm->data_pulse = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) fsm->b_srp_done = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) case OTG_STATE_B_PERIPHERAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) if (fsm->otg->gadget)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) fsm->otg->gadget->host_request_flag = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) case OTG_STATE_B_WAIT_ACON:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) otg_del_timer(fsm, B_ASE0_BRST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) fsm->b_ase0_brst_tmout = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) case OTG_STATE_B_HOST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) case OTG_STATE_A_IDLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) fsm->adp_prb = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) case OTG_STATE_A_WAIT_VRISE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) otg_del_timer(fsm, A_WAIT_VRISE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) fsm->a_wait_vrise_tmout = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) case OTG_STATE_A_WAIT_BCON:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) otg_del_timer(fsm, A_WAIT_BCON);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) fsm->a_wait_bcon_tmout = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) case OTG_STATE_A_HOST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) otg_del_timer(fsm, A_WAIT_ENUM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) case OTG_STATE_A_SUSPEND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) otg_del_timer(fsm, A_AIDL_BDIS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) fsm->a_aidl_bdis_tmout = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) fsm->a_suspend_req_inf = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) case OTG_STATE_A_PERIPHERAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) otg_del_timer(fsm, A_BIDL_ADIS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) fsm->a_bidl_adis_tmout = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) if (fsm->otg->gadget)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) fsm->otg->gadget->host_request_flag = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) case OTG_STATE_A_WAIT_VFALL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) otg_del_timer(fsm, A_WAIT_VFALL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) fsm->a_wait_vfall_tmout = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) otg_del_timer(fsm, A_WAIT_VRISE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) case OTG_STATE_A_VBUS_ERR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) static void otg_hnp_polling_work(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) struct otg_fsm *fsm = container_of(to_delayed_work(work),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) struct otg_fsm, hnp_polling_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) struct usb_device *udev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) enum usb_otg_state state = fsm->otg->state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) u8 flag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) int retval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) if (state != OTG_STATE_A_HOST && state != OTG_STATE_B_HOST)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) udev = usb_hub_find_child(fsm->otg->host->root_hub, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) if (!udev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) dev_err(fsm->otg->host->controller,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) "no usb dev connected, can't start HNP polling\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) *fsm->host_req_flag = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) /* Get host request flag from connected USB device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) retval = usb_control_msg(udev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) usb_rcvctrlpipe(udev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) USB_REQ_GET_STATUS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) USB_DIR_IN | USB_RECIP_DEVICE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) OTG_STS_SELECTOR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) fsm->host_req_flag,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) USB_CTRL_GET_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) if (retval != 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) dev_err(&udev->dev, "Get one byte OTG status failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) flag = *fsm->host_req_flag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) if (flag == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) /* Continue HNP polling */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) schedule_delayed_work(&fsm->hnp_polling_work,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) msecs_to_jiffies(T_HOST_REQ_POLL));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) } else if (flag != HOST_REQUEST_FLAG) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) dev_err(&udev->dev, "host request flag %d is invalid\n", flag);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) /* Host request flag is set */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) if (state == OTG_STATE_A_HOST) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) /* Set b_hnp_enable */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) if (!fsm->otg->host->b_hnp_enable) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) retval = usb_control_msg(udev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) usb_sndctrlpipe(udev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) USB_REQ_SET_FEATURE, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) USB_DEVICE_B_HNP_ENABLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 0, NULL, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) USB_CTRL_SET_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) if (retval >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) fsm->otg->host->b_hnp_enable = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) fsm->a_bus_req = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) } else if (state == OTG_STATE_B_HOST) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) fsm->b_bus_req = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) otg_statemachine(fsm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) static void otg_start_hnp_polling(struct otg_fsm *fsm)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) * The memory of host_req_flag should be allocated by
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) * controller driver, otherwise, hnp polling is not started.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) if (!fsm->host_req_flag)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) if (!fsm->hnp_work_inited) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) INIT_DELAYED_WORK(&fsm->hnp_polling_work, otg_hnp_polling_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) fsm->hnp_work_inited = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) schedule_delayed_work(&fsm->hnp_polling_work,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) msecs_to_jiffies(T_HOST_REQ_POLL));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) /* Called when entering a state */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) static int otg_set_state(struct otg_fsm *fsm, enum usb_otg_state new_state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) if (fsm->otg->state == new_state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) VDBG("Set state: %s\n", usb_otg_state_string(new_state));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) otg_leave_state(fsm, fsm->otg->state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) switch (new_state) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) case OTG_STATE_B_IDLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) otg_drv_vbus(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) otg_chrg_vbus(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) otg_loc_conn(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) * Driver is responsible for starting ADP probing
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) * if ADP sensing times out.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) otg_start_adp_sns(fsm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) otg_set_protocol(fsm, PROTO_UNDEF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) otg_add_timer(fsm, B_SE0_SRP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) case OTG_STATE_B_SRP_INIT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) otg_start_pulse(fsm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) otg_set_protocol(fsm, PROTO_UNDEF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) otg_add_timer(fsm, B_SRP_FAIL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) case OTG_STATE_B_PERIPHERAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) otg_chrg_vbus(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) otg_set_protocol(fsm, PROTO_GADGET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) otg_loc_conn(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) case OTG_STATE_B_WAIT_ACON:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) otg_chrg_vbus(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) otg_loc_conn(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) otg_set_protocol(fsm, PROTO_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) otg_add_timer(fsm, B_ASE0_BRST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) fsm->a_bus_suspend = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) case OTG_STATE_B_HOST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) otg_chrg_vbus(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) otg_loc_conn(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) otg_loc_sof(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) otg_set_protocol(fsm, PROTO_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) usb_bus_start_enum(fsm->otg->host,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) fsm->otg->host->otg_port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) otg_start_hnp_polling(fsm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) case OTG_STATE_A_IDLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) otg_drv_vbus(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) otg_chrg_vbus(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) otg_loc_conn(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) otg_start_adp_prb(fsm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) otg_set_protocol(fsm, PROTO_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) case OTG_STATE_A_WAIT_VRISE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) otg_drv_vbus(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) otg_loc_conn(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) otg_set_protocol(fsm, PROTO_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) otg_add_timer(fsm, A_WAIT_VRISE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) case OTG_STATE_A_WAIT_BCON:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) otg_drv_vbus(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) otg_loc_conn(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) otg_set_protocol(fsm, PROTO_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) otg_add_timer(fsm, A_WAIT_BCON);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) case OTG_STATE_A_HOST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) otg_drv_vbus(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) otg_loc_conn(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) otg_loc_sof(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) otg_set_protocol(fsm, PROTO_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) * When HNP is triggered while a_bus_req = 0, a_host will
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) * suspend too fast to complete a_set_b_hnp_en
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) if (!fsm->a_bus_req || fsm->a_suspend_req_inf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) otg_add_timer(fsm, A_WAIT_ENUM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) otg_start_hnp_polling(fsm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) case OTG_STATE_A_SUSPEND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) otg_drv_vbus(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) otg_loc_conn(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) otg_set_protocol(fsm, PROTO_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) otg_add_timer(fsm, A_AIDL_BDIS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) case OTG_STATE_A_PERIPHERAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) otg_set_protocol(fsm, PROTO_GADGET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) otg_drv_vbus(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) otg_loc_conn(fsm, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) otg_add_timer(fsm, A_BIDL_ADIS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) case OTG_STATE_A_WAIT_VFALL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) otg_drv_vbus(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) otg_loc_conn(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) otg_set_protocol(fsm, PROTO_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) otg_add_timer(fsm, A_WAIT_VFALL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) case OTG_STATE_A_VBUS_ERR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) otg_drv_vbus(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) otg_loc_conn(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) otg_loc_sof(fsm, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) otg_set_protocol(fsm, PROTO_UNDEF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) fsm->otg->state = new_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) fsm->state_changed = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) /* State change judgement */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) int otg_statemachine(struct otg_fsm *fsm)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) enum usb_otg_state state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) mutex_lock(&fsm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) state = fsm->otg->state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) fsm->state_changed = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) /* State machine state change judgement */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) switch (state) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) case OTG_STATE_UNDEFINED:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) VDBG("fsm->id = %d\n", fsm->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) if (fsm->id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) otg_set_state(fsm, OTG_STATE_B_IDLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) otg_set_state(fsm, OTG_STATE_A_IDLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) case OTG_STATE_B_IDLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) if (!fsm->id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) otg_set_state(fsm, OTG_STATE_A_IDLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) else if (fsm->b_sess_vld && fsm->otg->gadget)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) otg_set_state(fsm, OTG_STATE_B_PERIPHERAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) else if ((fsm->b_bus_req || fsm->adp_change || fsm->power_up) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) fsm->b_ssend_srp && fsm->b_se0_srp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) otg_set_state(fsm, OTG_STATE_B_SRP_INIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) case OTG_STATE_B_SRP_INIT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) if (!fsm->id || fsm->b_srp_done)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) otg_set_state(fsm, OTG_STATE_B_IDLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) case OTG_STATE_B_PERIPHERAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) if (!fsm->id || !fsm->b_sess_vld)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) otg_set_state(fsm, OTG_STATE_B_IDLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) else if (fsm->b_bus_req && fsm->otg->
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) gadget->b_hnp_enable && fsm->a_bus_suspend)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) otg_set_state(fsm, OTG_STATE_B_WAIT_ACON);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) case OTG_STATE_B_WAIT_ACON:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) if (fsm->a_conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) otg_set_state(fsm, OTG_STATE_B_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) else if (!fsm->id || !fsm->b_sess_vld)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) otg_set_state(fsm, OTG_STATE_B_IDLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) else if (fsm->a_bus_resume || fsm->b_ase0_brst_tmout) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) fsm->b_ase0_brst_tmout = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) otg_set_state(fsm, OTG_STATE_B_PERIPHERAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) case OTG_STATE_B_HOST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) if (!fsm->id || !fsm->b_sess_vld)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) otg_set_state(fsm, OTG_STATE_B_IDLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) else if (!fsm->b_bus_req || !fsm->a_conn || fsm->test_device)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) otg_set_state(fsm, OTG_STATE_B_PERIPHERAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) case OTG_STATE_A_IDLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) if (fsm->id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) otg_set_state(fsm, OTG_STATE_B_IDLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) else if (!fsm->a_bus_drop && (fsm->a_bus_req ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) fsm->a_srp_det || fsm->adp_change || fsm->power_up))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) otg_set_state(fsm, OTG_STATE_A_WAIT_VRISE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) case OTG_STATE_A_WAIT_VRISE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) if (fsm->a_vbus_vld)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) otg_set_state(fsm, OTG_STATE_A_WAIT_BCON);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) else if (fsm->id || fsm->a_bus_drop ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) fsm->a_wait_vrise_tmout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) case OTG_STATE_A_WAIT_BCON:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) if (!fsm->a_vbus_vld)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) otg_set_state(fsm, OTG_STATE_A_VBUS_ERR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) else if (fsm->b_conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) otg_set_state(fsm, OTG_STATE_A_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) else if (fsm->id || fsm->a_bus_drop || fsm->a_wait_bcon_tmout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) case OTG_STATE_A_HOST:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) if (fsm->id || fsm->a_bus_drop)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) else if ((!fsm->a_bus_req || fsm->a_suspend_req_inf) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) fsm->otg->host->b_hnp_enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) otg_set_state(fsm, OTG_STATE_A_SUSPEND);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) else if (!fsm->b_conn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) otg_set_state(fsm, OTG_STATE_A_WAIT_BCON);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) else if (!fsm->a_vbus_vld)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) otg_set_state(fsm, OTG_STATE_A_VBUS_ERR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) case OTG_STATE_A_SUSPEND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) if (!fsm->b_conn && fsm->otg->host->b_hnp_enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) otg_set_state(fsm, OTG_STATE_A_PERIPHERAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) else if (!fsm->b_conn && !fsm->otg->host->b_hnp_enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) otg_set_state(fsm, OTG_STATE_A_WAIT_BCON);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) else if (fsm->a_bus_req || fsm->b_bus_resume)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) otg_set_state(fsm, OTG_STATE_A_HOST);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) else if (fsm->id || fsm->a_bus_drop || fsm->a_aidl_bdis_tmout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) else if (!fsm->a_vbus_vld)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) otg_set_state(fsm, OTG_STATE_A_VBUS_ERR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) case OTG_STATE_A_PERIPHERAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) if (fsm->id || fsm->a_bus_drop)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) else if (fsm->a_bidl_adis_tmout || fsm->b_bus_suspend)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) otg_set_state(fsm, OTG_STATE_A_WAIT_BCON);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) else if (!fsm->a_vbus_vld)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) otg_set_state(fsm, OTG_STATE_A_VBUS_ERR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) case OTG_STATE_A_WAIT_VFALL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) if (fsm->a_wait_vfall_tmout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) otg_set_state(fsm, OTG_STATE_A_IDLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) case OTG_STATE_A_VBUS_ERR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) if (fsm->id || fsm->a_bus_drop || fsm->a_clr_err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) mutex_unlock(&fsm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) VDBG("quit statemachine, changed = %d\n", fsm->state_changed);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) return fsm->state_changed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) EXPORT_SYMBOL_GPL(otg_statemachine);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags