Lines Matching refs:fsm
35 static int otg_set_protocol(struct otg_fsm *fsm, int protocol) in otg_set_protocol() argument
39 if (fsm->protocol != protocol) { in otg_set_protocol()
41 fsm->protocol, protocol); in otg_set_protocol()
43 if (fsm->protocol == PROTO_HOST) in otg_set_protocol()
44 ret = otg_start_host(fsm, 0); in otg_set_protocol()
45 else if (fsm->protocol == PROTO_GADGET) in otg_set_protocol()
46 ret = otg_start_gadget(fsm, 0); in otg_set_protocol()
52 ret = otg_start_host(fsm, 1); in otg_set_protocol()
54 ret = otg_start_gadget(fsm, 1); in otg_set_protocol()
58 fsm->protocol = protocol; in otg_set_protocol()
66 static void otg_leave_state(struct otg_fsm *fsm, enum usb_otg_state old_state) in otg_leave_state() argument
70 otg_del_timer(fsm, B_SE0_SRP); in otg_leave_state()
71 fsm->b_se0_srp = 0; in otg_leave_state()
72 fsm->adp_sns = 0; in otg_leave_state()
73 fsm->adp_prb = 0; in otg_leave_state()
76 fsm->data_pulse = 0; in otg_leave_state()
77 fsm->b_srp_done = 0; in otg_leave_state()
80 if (fsm->otg->gadget) in otg_leave_state()
81 fsm->otg->gadget->host_request_flag = 0; in otg_leave_state()
84 otg_del_timer(fsm, B_ASE0_BRST); in otg_leave_state()
85 fsm->b_ase0_brst_tmout = 0; in otg_leave_state()
90 fsm->adp_prb = 0; in otg_leave_state()
93 otg_del_timer(fsm, A_WAIT_VRISE); in otg_leave_state()
94 fsm->a_wait_vrise_tmout = 0; in otg_leave_state()
97 otg_del_timer(fsm, A_WAIT_BCON); in otg_leave_state()
98 fsm->a_wait_bcon_tmout = 0; in otg_leave_state()
101 otg_del_timer(fsm, A_WAIT_ENUM); in otg_leave_state()
104 otg_del_timer(fsm, A_AIDL_BDIS); in otg_leave_state()
105 fsm->a_aidl_bdis_tmout = 0; in otg_leave_state()
106 fsm->a_suspend_req_inf = 0; in otg_leave_state()
109 otg_del_timer(fsm, A_BIDL_ADIS); in otg_leave_state()
110 fsm->a_bidl_adis_tmout = 0; in otg_leave_state()
111 if (fsm->otg->gadget) in otg_leave_state()
112 fsm->otg->gadget->host_request_flag = 0; in otg_leave_state()
115 otg_del_timer(fsm, A_WAIT_VFALL); in otg_leave_state()
116 fsm->a_wait_vfall_tmout = 0; in otg_leave_state()
117 otg_del_timer(fsm, A_WAIT_VRISE); in otg_leave_state()
128 struct otg_fsm *fsm = container_of(to_delayed_work(work), in otg_hnp_polling_work() local
131 enum usb_otg_state state = fsm->otg->state; in otg_hnp_polling_work()
138 udev = usb_hub_find_child(fsm->otg->host->root_hub, 1); in otg_hnp_polling_work()
140 dev_err(fsm->otg->host->controller, in otg_hnp_polling_work()
145 *fsm->host_req_flag = 0; in otg_hnp_polling_work()
153 fsm->host_req_flag, in otg_hnp_polling_work()
161 flag = *fsm->host_req_flag; in otg_hnp_polling_work()
164 schedule_delayed_work(&fsm->hnp_polling_work, in otg_hnp_polling_work()
175 if (!fsm->otg->host->b_hnp_enable) { in otg_hnp_polling_work()
183 fsm->otg->host->b_hnp_enable = 1; in otg_hnp_polling_work()
185 fsm->a_bus_req = 0; in otg_hnp_polling_work()
187 fsm->b_bus_req = 0; in otg_hnp_polling_work()
190 otg_statemachine(fsm); in otg_hnp_polling_work()
193 static void otg_start_hnp_polling(struct otg_fsm *fsm) in otg_start_hnp_polling() argument
199 if (!fsm->host_req_flag) in otg_start_hnp_polling()
202 INIT_DELAYED_WORK(&fsm->hnp_polling_work, otg_hnp_polling_work); in otg_start_hnp_polling()
203 schedule_delayed_work(&fsm->hnp_polling_work, in otg_start_hnp_polling()
208 static int otg_set_state(struct otg_fsm *fsm, enum usb_otg_state new_state) in otg_set_state() argument
210 if (fsm->otg->state == new_state) in otg_set_state()
213 otg_leave_state(fsm, fsm->otg->state); in otg_set_state()
216 otg_drv_vbus(fsm, 0); in otg_set_state()
217 otg_chrg_vbus(fsm, 0); in otg_set_state()
218 otg_loc_conn(fsm, 0); in otg_set_state()
219 otg_loc_sof(fsm, 0); in otg_set_state()
224 otg_start_adp_sns(fsm); in otg_set_state()
225 otg_set_protocol(fsm, PROTO_UNDEF); in otg_set_state()
226 otg_add_timer(fsm, B_SE0_SRP); in otg_set_state()
229 otg_start_pulse(fsm); in otg_set_state()
230 otg_loc_sof(fsm, 0); in otg_set_state()
231 otg_set_protocol(fsm, PROTO_UNDEF); in otg_set_state()
232 otg_add_timer(fsm, B_SRP_FAIL); in otg_set_state()
235 otg_chrg_vbus(fsm, 0); in otg_set_state()
236 otg_loc_sof(fsm, 0); in otg_set_state()
237 otg_set_protocol(fsm, PROTO_GADGET); in otg_set_state()
238 otg_loc_conn(fsm, 1); in otg_set_state()
241 otg_chrg_vbus(fsm, 0); in otg_set_state()
242 otg_loc_conn(fsm, 0); in otg_set_state()
243 otg_loc_sof(fsm, 0); in otg_set_state()
244 otg_set_protocol(fsm, PROTO_HOST); in otg_set_state()
245 otg_add_timer(fsm, B_ASE0_BRST); in otg_set_state()
246 fsm->a_bus_suspend = 0; in otg_set_state()
249 otg_chrg_vbus(fsm, 0); in otg_set_state()
250 otg_loc_conn(fsm, 0); in otg_set_state()
251 otg_loc_sof(fsm, 1); in otg_set_state()
252 otg_set_protocol(fsm, PROTO_HOST); in otg_set_state()
253 usb_bus_start_enum(fsm->otg->host, in otg_set_state()
254 fsm->otg->host->otg_port); in otg_set_state()
255 otg_start_hnp_polling(fsm); in otg_set_state()
258 otg_drv_vbus(fsm, 0); in otg_set_state()
259 otg_chrg_vbus(fsm, 0); in otg_set_state()
260 otg_loc_conn(fsm, 0); in otg_set_state()
261 otg_loc_sof(fsm, 0); in otg_set_state()
262 otg_start_adp_prb(fsm); in otg_set_state()
263 otg_set_protocol(fsm, PROTO_HOST); in otg_set_state()
266 otg_drv_vbus(fsm, 1); in otg_set_state()
267 otg_loc_conn(fsm, 0); in otg_set_state()
268 otg_loc_sof(fsm, 0); in otg_set_state()
269 otg_set_protocol(fsm, PROTO_HOST); in otg_set_state()
270 otg_add_timer(fsm, A_WAIT_VRISE); in otg_set_state()
273 otg_drv_vbus(fsm, 1); in otg_set_state()
274 otg_loc_conn(fsm, 0); in otg_set_state()
275 otg_loc_sof(fsm, 0); in otg_set_state()
276 otg_set_protocol(fsm, PROTO_HOST); in otg_set_state()
277 otg_add_timer(fsm, A_WAIT_BCON); in otg_set_state()
280 otg_drv_vbus(fsm, 1); in otg_set_state()
281 otg_loc_conn(fsm, 0); in otg_set_state()
282 otg_loc_sof(fsm, 1); in otg_set_state()
283 otg_set_protocol(fsm, PROTO_HOST); in otg_set_state()
288 if (!fsm->a_bus_req || fsm->a_suspend_req_inf) in otg_set_state()
289 otg_add_timer(fsm, A_WAIT_ENUM); in otg_set_state()
290 otg_start_hnp_polling(fsm); in otg_set_state()
293 otg_drv_vbus(fsm, 1); in otg_set_state()
294 otg_loc_conn(fsm, 0); in otg_set_state()
295 otg_loc_sof(fsm, 0); in otg_set_state()
296 otg_set_protocol(fsm, PROTO_HOST); in otg_set_state()
297 otg_add_timer(fsm, A_AIDL_BDIS); in otg_set_state()
301 otg_loc_sof(fsm, 0); in otg_set_state()
302 otg_set_protocol(fsm, PROTO_GADGET); in otg_set_state()
303 otg_drv_vbus(fsm, 1); in otg_set_state()
304 otg_loc_conn(fsm, 1); in otg_set_state()
305 otg_add_timer(fsm, A_BIDL_ADIS); in otg_set_state()
308 otg_drv_vbus(fsm, 0); in otg_set_state()
309 otg_loc_conn(fsm, 0); in otg_set_state()
310 otg_loc_sof(fsm, 0); in otg_set_state()
311 otg_set_protocol(fsm, PROTO_HOST); in otg_set_state()
312 otg_add_timer(fsm, A_WAIT_VFALL); in otg_set_state()
315 otg_drv_vbus(fsm, 0); in otg_set_state()
316 otg_loc_conn(fsm, 0); in otg_set_state()
317 otg_loc_sof(fsm, 0); in otg_set_state()
318 otg_set_protocol(fsm, PROTO_UNDEF); in otg_set_state()
324 fsm->otg->state = new_state; in otg_set_state()
325 fsm->state_changed = 1; in otg_set_state()
330 int otg_statemachine(struct otg_fsm *fsm) in otg_statemachine() argument
334 mutex_lock(&fsm->lock); in otg_statemachine()
336 state = fsm->otg->state; in otg_statemachine()
337 fsm->state_changed = 0; in otg_statemachine()
342 VDBG("fsm->id = %d\n", fsm->id); in otg_statemachine()
343 if (fsm->id) in otg_statemachine()
344 otg_set_state(fsm, OTG_STATE_B_IDLE); in otg_statemachine()
346 otg_set_state(fsm, OTG_STATE_A_IDLE); in otg_statemachine()
349 if (!fsm->id) in otg_statemachine()
350 otg_set_state(fsm, OTG_STATE_A_IDLE); in otg_statemachine()
351 else if (fsm->b_sess_vld && fsm->otg->gadget) in otg_statemachine()
352 otg_set_state(fsm, OTG_STATE_B_PERIPHERAL); in otg_statemachine()
353 else if ((fsm->b_bus_req || fsm->adp_change || fsm->power_up) && in otg_statemachine()
354 fsm->b_ssend_srp && fsm->b_se0_srp) in otg_statemachine()
355 otg_set_state(fsm, OTG_STATE_B_SRP_INIT); in otg_statemachine()
358 if (!fsm->id || fsm->b_srp_done) in otg_statemachine()
359 otg_set_state(fsm, OTG_STATE_B_IDLE); in otg_statemachine()
362 if (!fsm->id || !fsm->b_sess_vld) in otg_statemachine()
363 otg_set_state(fsm, OTG_STATE_B_IDLE); in otg_statemachine()
364 else if (fsm->b_bus_req && fsm->otg-> in otg_statemachine()
365 gadget->b_hnp_enable && fsm->a_bus_suspend) in otg_statemachine()
366 otg_set_state(fsm, OTG_STATE_B_WAIT_ACON); in otg_statemachine()
369 if (fsm->a_conn) in otg_statemachine()
370 otg_set_state(fsm, OTG_STATE_B_HOST); in otg_statemachine()
371 else if (!fsm->id || !fsm->b_sess_vld) in otg_statemachine()
372 otg_set_state(fsm, OTG_STATE_B_IDLE); in otg_statemachine()
373 else if (fsm->a_bus_resume || fsm->b_ase0_brst_tmout) { in otg_statemachine()
374 fsm->b_ase0_brst_tmout = 0; in otg_statemachine()
375 otg_set_state(fsm, OTG_STATE_B_PERIPHERAL); in otg_statemachine()
379 if (!fsm->id || !fsm->b_sess_vld) in otg_statemachine()
380 otg_set_state(fsm, OTG_STATE_B_IDLE); in otg_statemachine()
381 else if (!fsm->b_bus_req || !fsm->a_conn || fsm->test_device) in otg_statemachine()
382 otg_set_state(fsm, OTG_STATE_B_PERIPHERAL); in otg_statemachine()
385 if (fsm->id) in otg_statemachine()
386 otg_set_state(fsm, OTG_STATE_B_IDLE); in otg_statemachine()
387 else if (!fsm->a_bus_drop && (fsm->a_bus_req || in otg_statemachine()
388 fsm->a_srp_det || fsm->adp_change || fsm->power_up)) in otg_statemachine()
389 otg_set_state(fsm, OTG_STATE_A_WAIT_VRISE); in otg_statemachine()
392 if (fsm->a_vbus_vld) in otg_statemachine()
393 otg_set_state(fsm, OTG_STATE_A_WAIT_BCON); in otg_statemachine()
394 else if (fsm->id || fsm->a_bus_drop || in otg_statemachine()
395 fsm->a_wait_vrise_tmout) in otg_statemachine()
396 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL); in otg_statemachine()
399 if (!fsm->a_vbus_vld) in otg_statemachine()
400 otg_set_state(fsm, OTG_STATE_A_VBUS_ERR); in otg_statemachine()
401 else if (fsm->b_conn) in otg_statemachine()
402 otg_set_state(fsm, OTG_STATE_A_HOST); in otg_statemachine()
403 else if (fsm->id || fsm->a_bus_drop || fsm->a_wait_bcon_tmout) in otg_statemachine()
404 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL); in otg_statemachine()
407 if (fsm->id || fsm->a_bus_drop) in otg_statemachine()
408 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL); in otg_statemachine()
409 else if ((!fsm->a_bus_req || fsm->a_suspend_req_inf) && in otg_statemachine()
410 fsm->otg->host->b_hnp_enable) in otg_statemachine()
411 otg_set_state(fsm, OTG_STATE_A_SUSPEND); in otg_statemachine()
412 else if (!fsm->b_conn) in otg_statemachine()
413 otg_set_state(fsm, OTG_STATE_A_WAIT_BCON); in otg_statemachine()
414 else if (!fsm->a_vbus_vld) in otg_statemachine()
415 otg_set_state(fsm, OTG_STATE_A_VBUS_ERR); in otg_statemachine()
418 if (!fsm->b_conn && fsm->otg->host->b_hnp_enable) in otg_statemachine()
419 otg_set_state(fsm, OTG_STATE_A_PERIPHERAL); in otg_statemachine()
420 else if (!fsm->b_conn && !fsm->otg->host->b_hnp_enable) in otg_statemachine()
421 otg_set_state(fsm, OTG_STATE_A_WAIT_BCON); in otg_statemachine()
422 else if (fsm->a_bus_req || fsm->b_bus_resume) in otg_statemachine()
423 otg_set_state(fsm, OTG_STATE_A_HOST); in otg_statemachine()
424 else if (fsm->id || fsm->a_bus_drop || fsm->a_aidl_bdis_tmout) in otg_statemachine()
425 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL); in otg_statemachine()
426 else if (!fsm->a_vbus_vld) in otg_statemachine()
427 otg_set_state(fsm, OTG_STATE_A_VBUS_ERR); in otg_statemachine()
430 if (fsm->id || fsm->a_bus_drop) in otg_statemachine()
431 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL); in otg_statemachine()
432 else if (fsm->a_bidl_adis_tmout || fsm->b_bus_suspend) in otg_statemachine()
433 otg_set_state(fsm, OTG_STATE_A_WAIT_BCON); in otg_statemachine()
434 else if (!fsm->a_vbus_vld) in otg_statemachine()
435 otg_set_state(fsm, OTG_STATE_A_VBUS_ERR); in otg_statemachine()
438 if (fsm->a_wait_vfall_tmout) in otg_statemachine()
439 otg_set_state(fsm, OTG_STATE_A_IDLE); in otg_statemachine()
442 if (fsm->id || fsm->a_bus_drop || fsm->a_clr_err) in otg_statemachine()
443 otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL); in otg_statemachine()
448 mutex_unlock(&fsm->lock); in otg_statemachine()
450 VDBG("quit statemachine, changed = %d\n", fsm->state_changed); in otg_statemachine()
451 return fsm->state_changed; in otg_statemachine()