otg_fsm.rar_FSM_otg

/* * otg_fsm.c - ChipIdea USB IP core OTG FSM driver * * Copyright (C) 2014 Freescale Semiconductor, Inc. * * Author: Jun Li * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. */ /* * This file mainly handles OTG fsm, it includes OTG fsm operations * for HNP and SRP. * * TODO List * - ADP * - OTG test device */ #include <linux/usb/otg.h> #include <linux/usb/gadget.h> #include <linux/usb/hcd.h> #include <linux/usb/chipidea.h> #include <linux/regulator/consumer.h> #include "ci.h" #include "bits.h" #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 for otg: interact with user space app */ static ssize_t get_a_bus_req(struct device *dev, struct device_attribute *attr, char *buf) { char *next; unsigned size, t; struct ci_hdrc *ci = dev_get_drvdata(dev); next = buf; size = PAGE_SIZE; t = scnprintf(next, size, "%d\n", ci->fsm.a_bus_req); size -= t; next += t; return PAGE_SIZE - size; } static ssize_t set_a_bus_req(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct ci_hdrc *ci = dev_get_drvdata(dev); if (count > 2) return -1; mutex_lock(&ci->fsm.lock); if (buf[0] == '0') { ci->fsm.a_bus_req = 0; } else if (buf[0] == '1') { /* If a_bus_drop is TRUE, a_bus_req can't be set */ if (ci->fsm.a_bus_drop) { mutex_unlock(&ci->fsm.lock); return count; } ci->fsm.a_bus_req = 1; } ci_otg_queue_work(ci); mutex_unlock(&ci->fsm.lock); return count; } static DEVICE_ATTR(a_bus_req, S_IRUGO | S_IWUSR, get_a_bus_req, set_a_bus_req); static ssize_t get_a_bus_drop(struct device *dev, struct device_attribute *attr, char *buf) { char *next; unsigned size, t; struct ci_hdrc *ci = dev_get_drvdata(dev); next = buf; size = PAGE_SIZE; t = scnprintf(next, size, "%d\n", ci->fsm.a_bus_drop); size -= t; next += t; return PAGE_SIZE - size; } static ssize_t set_a_bus_drop(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct ci_hdrc *ci = dev_get_drvdata(dev); if (count > 2) return -1; mutex_lock(&ci->fsm.lock); if (buf[0] == '0') { ci->fsm.a_bus_drop = 0; } else if (buf[0] == '1') { ci->fsm.a_bus_drop = 1; ci->fsm.a_bus_req = 0; } ci_otg_queue_work(ci); mutex_unlock(&ci->fsm.lock); return count; } static DEVICE_ATTR(a_bus_drop, S_IRUGO | S_IWUSR, get_a_bus_drop, set_a_bus_drop); static ssize_t get_b_bus_req(struct device *dev, struct device_attribute *attr, char *buf) { char *next; unsigned size, t; struct ci_hdrc *ci = dev_get_drvdata(dev); next = buf; size = PAGE_SIZE; t = scnprintf(next, size, "%d\n", ci->fsm.b_bus_req); size -= t; next += t; return PAGE_SIZE - size; } static ssize_t set_b_bus_req(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct ci_hdrc *ci = dev_get_drvdata(dev); if (count > 2) return -1; mutex_lock(&ci->fsm.lock); if (buf[0] == '0') ci->fsm.b_bus_req = 0; else if (buf[0] == '1') ci->fsm.b_bus_req = 1; ci_otg_queue_work(ci); mutex_unlock(&ci->fsm.lock); return count; } static DEVICE_ATTR(b_bus_req, S_IRUGO | S_IWUSR, get_b_bus_req, set_b_bus_req); static ssize_t set_a_clr_err(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { struct ci_hdrc *ci = dev_get_drvdata(dev); if (count > 2) return -1; mutex_lock(&ci->fsm.lock); if (buf[0] == '1') ci->fsm.a_clr_err = 1; ci_otg_queue_work(ci); mutex_unlock(&ci->fsm.lock); return count; } static DEVICE_ATTR(a_clr_err, S_IWUSR, NULL, set_a_clr_err); static struct attribute *inputs_attrs[] = { &dev_attr_a_bus_req.attr, &dev_attr_a_bus_drop.attr, &dev_attr_b_bus_req.attr, &dev_attr_a_clr_err.attr, NULL, }; static struct attribute_group inputs_attr_group = { .name = "inputs", .attrs = inputs_attrs, }; /* * Add timer to active timer list */ static void ci_otg_add_timer(struct ci_hdrc *ci, enum ci_otg_fsm_timer_index t) { struct ci_otg_fsm_timer *tmp_timer; struct ci_otg_fsm_timer *timer = ci->fsm_timer->timer_list[t]; struct list_head *active_timers = &ci->fsm_timer->active_timers; if (t >= NUM_CI_OTG_FSM_TIMERS) return; /* * Check if the timer is already in the active list, * if so update timer count */ list_for_each_entry(tmp_timer, active_timers, list) if (tmp_timer == timer) { timer->count = timer->expires; return; } timer->count = timer->expires; list_add_tail(&timer->list, active_timers); /* Enable 1ms irq */ if (!(hw_read_otgsc(ci, OTGSC_1MSIE))) hw_write_otgsc(ci, OTGSC_1MSIE, OTGSC_1MSIE); } /* * Remove timer from active timer list */ static void ci_otg_del_timer(struct ci_hdrc *ci, enum ci_otg_fsm_timer_index t) { struct ci_otg_fsm_timer *tmp_timer, *del_tmp; struct ci_otg_fsm_timer *timer = ci->fsm_timer->timer_list[t]; struct list_head *active_timers = &ci->fsm_timer->active_timers; if (t >= NUM_CI_OTG_FSM_TIMERS) return; list_for_each_entry_safe(tmp_timer, del_tmp, active_timers, list) if (tmp_timer == timer) list_del(&timer->list); /* Disable 1ms irq if there is no any active timer */ if (list_empty(active_timers)) hw_write_otgsc(ci, OTGSC_1MSIE, 0); } /* * Reduce timer count by 1, and find timeout conditions. * Called by otg 1ms timer interrupt */ static inline 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)) hw_write_otgsc(ci, OTGSC_1MSIE, 0); return expired; } /* 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); ci_otg_queue_work(ci); } static void a_wait_vfall_tmout_func(void *ptr, unsigned long indicator) { struct ci_hdrc *ci = (struct ci_hdrc *)ptr; set_tmout(ci, indicator); /* Disable port power */ hw_write(ci, OP_PORTSC, PORTSC_W1C_BITS | PORTSC_PP, 0); /* Clear existing DP irq */ hw_write_otgsc(ci, OTGSC_DPIS, OTGSC_DPIS); /* Enable data pulse irq */ hw_write_otgsc(ci, OTGSC_DPIE, OTGSC_DPIE); ci_otg_queue_work(ci); } static void b_ase0_brst_tmout_func(void *ptr, unsigned long indicator) { struct ci_hdrc *ci = (struct ci_hdrc *)ptr; set_tmout(ci, indicator); if (!hw_read_otgsc(ci, OTGSC_BSV)) ci->fsm.b_sess_vld = 0; ci_otg_queue_work(ci); } 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->fsm.otg->state == OTG_STATE_B_IDLE) ci_otg_queue_work(ci); } 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_otgsc(ci, OTGSC_BSV))) { ci->fsm.b_sess_vld = 0; ci_otg_add_timer(ci, B_SSEND_SRP); ci_otg_queue_work(ci); } } static void b_data_pulse_end(void *ptr, unsigned long indicator) { struct ci_hdrc *ci = (