Lines Matching refs:fsm
19 #include <linux/usb/otg-fsm.h>
29 static int otg_set_protocol(struct otg_fsm *fsm, int protocol)
33 if (fsm->protocol != protocol) {
34 VDBG("Changing role fsm->protocol= %d; new protocol= %d\n",
35 fsm->protocol, protocol);
37 if (fsm->protocol == PROTO_HOST)
38 ret = otg_start_host(fsm, 0);
39 else if (fsm->protocol == PROTO_GADGET)
40 ret = otg_start_gadget(fsm, 0);
46 ret = otg_start_host(fsm, 1);
48 ret = otg_start_gadget(fsm, 1);
52 fsm->protocol = protocol;
60 static void otg_leave_state(struct otg_fsm *fsm, enum usb_otg_state old_state)
64 otg_del_timer(fsm, B_SE0_SRP);
65 fsm->b_se0_srp = 0;
66 fsm->adp_sns = 0;
67 fsm->adp_prb = 0;
70 fsm->data_pulse = 0;
71 fsm->b_srp_done = 0;
74 if (fsm->otg->gadget)
75 fsm->otg->gadget->host_request_flag = 0;
78 otg_del_timer(fsm, B_ASE0_BRST);
79 fsm->b_ase0_brst_tmout = 0;
84 fsm->adp_prb = 0;
87 otg_del_timer(fsm, A_WAIT_VRISE);
88 fsm->a_wait_vrise_tmout = 0;
91 otg_del_timer(fsm, A_WAIT_BCON);
92 fsm->a_wait_bcon_tmout = 0;
95 otg_del_timer(fsm, A_WAIT_ENUM);
98 otg_del_timer(fsm, A_AIDL_BDIS);
99 fsm->a_aidl_bdis_tmout = 0;
100 fsm->a_suspend_req_inf = 0;
103 otg_del_timer(fsm, A_BIDL_ADIS);
104 fsm->a_bidl_adis_tmout = 0;
105 if (fsm->otg->gadget)
106 fsm->otg->gadget->host_request_flag = 0;
109 otg_del_timer(fsm, A_WAIT_VFALL);
110 fsm->a_wait_vfall_tmout = 0;
111 otg_del_timer(fsm, A_WAIT_VRISE);
122 struct otg_fsm *fsm = container_of(to_delayed_work(work),
125 enum usb_otg_state state = fsm->otg->state;
132 udev = usb_hub_find_child(fsm->otg->host->root_hub, 1);
134 dev_err(fsm->otg->host->controller,
139 *fsm->host_req_flag = 0;
147 fsm->host_req_flag,
155 flag = *fsm->host_req_flag;
158 schedule_delayed_work(&fsm->hnp_polling_work,
169 if (!fsm->otg->host->b_hnp_enable) {
177 fsm->otg->host->b_hnp_enable = 1;
179 fsm->a_bus_req = 0;
181 fsm->b_bus_req = 0;
184 otg_statemachine(fsm);
187 static void otg_start_hnp_polling(struct otg_fsm *fsm)
193 if (!fsm->host_req_flag)
196 if (!fsm->hnp_work_inited) {
197 INIT_DELAYED_WORK(&fsm->hnp_polling_work, otg_hnp_polling_work);
198 fsm->hnp_work_inited = true;
201 schedule_delayed_work(&fsm->hnp_polling_work,
206 static int otg_set_state(struct otg_fsm *fsm, enum usb_otg_state new_state)
208 if (fsm->otg->state == new_state)
211 otg_leave_state(fsm, fsm->otg->state);
214 otg_drv_vbus(fsm, 0);
215 otg_chrg_vbus(fsm, 0);
216 otg_loc_conn(fsm, 0);
217 otg_loc_sof(fsm, 0);
222 otg_start_adp_sns(fsm);
223 otg_set_protocol(fsm, PROTO_UNDEF);
224 otg_add_timer(fsm, B_SE0_SRP);
227 otg_start_pulse(fsm);
228 otg_loc_sof(fsm, 0);
229 otg_set_protocol(fsm, PROTO_UNDEF);
230 otg_add_timer(fsm, B_SRP_FAIL);
233 otg_chrg_vbus(fsm, 0);
234 otg_loc_sof(fsm, 0);
235 otg_set_protocol(fsm, PROTO_GADGET);
236 otg_loc_conn(fsm, 1);
239 otg_chrg_vbus(fsm, 0);
240 otg_loc_conn(fsm, 0);
241 otg_loc_sof(fsm, 0);
242 otg_set_protocol(fsm, PROTO_HOST);
243 otg_add_timer(fsm, B_ASE0_BRST);
244 fsm->a_bus_suspend = 0;
247 otg_chrg_vbus(fsm, 0);
248 otg_loc_conn(fsm, 0);
249 otg_loc_sof(fsm, 1);
250 otg_set_protocol(fsm, PROTO_HOST);
251 usb_bus_start_enum(fsm->otg->host,
252 fsm->otg->host->otg_port);
253 otg_start_hnp_polling(fsm);
256 otg_drv_vbus(fsm, 0);
257 otg_chrg_vbus(fsm, 0);
258 otg_loc_conn(fsm, 0);
259 otg_loc_sof(fsm, 0);
260 otg_start_adp_prb(fsm);
261 otg_set_protocol(fsm, PROTO_HOST);
264 otg_drv_vbus(fsm, 1);
265 otg_loc_conn(fsm, 0);
266 otg_loc_sof(fsm, 0);
267 otg_set_protocol(fsm, PROTO_HOST);
268 otg_add_timer(fsm, A_WAIT_VRISE);
271 otg_drv_vbus(fsm, 1);
272 otg_loc_conn(fsm, 0);
273 otg_loc_sof(fsm, 0);
274 otg_set_protocol(fsm, PROTO_HOST);
275 otg_add_timer(fsm, A_WAIT_BCON);
278 otg_drv_vbus(fsm, 1);
279 otg_loc_conn(fsm, 0);
280 otg_loc_sof(fsm, 1);
281 otg_set_protocol(fsm, PROTO_HOST);
286 if (!fsm->a_bus_req || fsm->a_suspend_req_inf)
287 otg_add_timer(fsm, A_WAIT_ENUM);
288 otg_start_hnp_polling(fsm);
291 otg_drv_vbus(fsm, 1);
292 otg_loc_conn(fsm, 0);
293 otg_loc_sof(fsm, 0);
294 otg_set_protocol(fsm, PROTO_HOST);
295 otg_add_timer(fsm, A_AIDL_BDIS);
299 otg_loc_sof(fsm, 0);
300 otg_set_protocol(fsm, PROTO_GADGET);
301 otg_drv_vbus(fsm, 1);
302 otg_loc_conn(fsm, 1);
303 otg_add_timer(fsm, A_BIDL_ADIS);
306 otg_drv_vbus(fsm, 0);
307 otg_loc_conn(fsm, 0);
308 otg_loc_sof(fsm, 0);
309 otg_set_protocol(fsm, PROTO_HOST);
310 otg_add_timer(fsm, A_WAIT_VFALL);
313 otg_drv_vbus(fsm, 0);
314 otg_loc_conn(fsm, 0);
315 otg_loc_sof(fsm, 0);
316 otg_set_protocol(fsm, PROTO_UNDEF);
322 fsm->otg->state = new_state;
323 fsm->state_changed = 1;
328 int otg_statemachine(struct otg_fsm *fsm)
332 mutex_lock(&fsm->lock);
334 state = fsm->otg->state;
335 fsm->state_changed = 0;
340 VDBG("fsm->id = %d\n", fsm->id);
341 if (fsm->id)
342 otg_set_state(fsm, OTG_STATE_B_IDLE);
344 otg_set_state(fsm, OTG_STATE_A_IDLE);
347 if (!fsm->id)
348 otg_set_state(fsm, OTG_STATE_A_IDLE);
349 else if (fsm->b_sess_vld && fsm->otg->gadget)
350 otg_set_state(fsm, OTG_STATE_B_PERIPHERAL);
351 else if ((fsm->b_bus_req || fsm->adp_change || fsm->power_up) &&
352 fsm->b_ssend_srp && fsm->b_se0_srp)
353 otg_set_state(fsm, OTG_STATE_B_SRP_INIT);
356 if (!fsm->id || fsm->b_srp_done)
357 otg_set_state(fsm, OTG_STATE_B_IDLE);
360 if (!fsm->id || !fsm->b_sess_vld)
361 otg_set_state(fsm, OTG_STATE_B_IDLE);
362 else if (fsm->b_bus_req && fsm->otg->
363 gadget->b_hnp_enable && fsm->a_bus_suspend)
364 otg_set_state(fsm, OTG_STATE_B_WAIT_ACON);
367 if (fsm->a_conn)
368 otg_set_state(fsm, OTG_STATE_B_HOST);
369 else if (!fsm->id || !fsm->b_sess_vld)
370 otg_set_state(fsm, OTG_STATE_B_IDLE);
371 else if (fsm->a_bus_resume || fsm->b_ase0_brst_tmout) {
372 fsm->b_ase0_brst_tmout = 0;
373 otg_set_state(fsm, OTG_STATE_B_PERIPHERAL);
377 if (!fsm->id || !fsm->b_sess_vld)
378 otg_set_state(fsm, OTG_STATE_B_IDLE);
379 else if (!fsm->b_bus_req || !fsm->a_conn || fsm->test_device)
380 otg_set_state(fsm, OTG_STATE_B_PERIPHERAL);
383 if (fsm->id)
384 otg_set_state(fsm, OTG_STATE_B_IDLE);
385 else if (!fsm->a_bus_drop && (fsm->a_bus_req ||
386 fsm->a_srp_det || fsm->adp_change || fsm->power_up))
387 otg_set_state(fsm, OTG_STATE_A_WAIT_VRISE);
390 if (fsm->a_vbus_vld)
391 otg_set_state(fsm, OTG_STATE_A_WAIT_BCON);
392 else if (fsm->id || fsm->a_bus_drop ||
393 fsm->a_wait_vrise_tmout)
394 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
397 if (!fsm->a_vbus_vld)
398 otg_set_state(fsm, OTG_STATE_A_VBUS_ERR);
399 else if (fsm->b_conn)
400 otg_set_state(fsm, OTG_STATE_A_HOST);
401 else if (fsm->id || fsm->a_bus_drop || fsm->a_wait_bcon_tmout)
402 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
405 if (fsm->id || fsm->a_bus_drop)
406 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
407 else if ((!fsm->a_bus_req || fsm->a_suspend_req_inf) &&
408 fsm->otg->host->b_hnp_enable)
409 otg_set_state(fsm, OTG_STATE_A_SUSPEND);
410 else if (!fsm->b_conn)
411 otg_set_state(fsm, OTG_STATE_A_WAIT_BCON);
412 else if (!fsm->a_vbus_vld)
413 otg_set_state(fsm, OTG_STATE_A_VBUS_ERR);
416 if (!fsm->b_conn && fsm->otg->host->b_hnp_enable)
417 otg_set_state(fsm, OTG_STATE_A_PERIPHERAL);
418 else if (!fsm->b_conn && !fsm->otg->host->b_hnp_enable)
419 otg_set_state(fsm, OTG_STATE_A_WAIT_BCON);
420 else if (fsm->a_bus_req || fsm->b_bus_resume)
421 otg_set_state(fsm, OTG_STATE_A_HOST);
422 else if (fsm->id || fsm->a_bus_drop || fsm->a_aidl_bdis_tmout)
423 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
424 else if (!fsm->a_vbus_vld)
425 otg_set_state(fsm, OTG_STATE_A_VBUS_ERR);
428 if (fsm->id || fsm->a_bus_drop)
429 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
430 else if (fsm->a_bidl_adis_tmout || fsm->b_bus_suspend)
431 otg_set_state(fsm, OTG_STATE_A_WAIT_BCON);
432 else if (!fsm->a_vbus_vld)
433 otg_set_state(fsm, OTG_STATE_A_VBUS_ERR);
436 if (fsm->a_wait_vfall_tmout)
437 otg_set_state(fsm, OTG_STATE_A_IDLE);
440 if (fsm->id || fsm->a_bus_drop || fsm->a_clr_err)
441 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
446 mutex_unlock(&fsm->lock);
448 VDBG("quit statemachine, changed = %d\n", fsm->state_changed);
449 return fsm->state_changed;