This patch adds sys input to control and show OTG fsm inputs by application, user can do host and preipheral role switch by change these inputs.
Signed-off-by: Li Jun <[email protected]> --- drivers/usb/chipidea/otg.c | 1 + drivers/usb/chipidea/otg_fsm.c | 204 ++++++++++++++++++++++++++++++++++++++++ drivers/usb/chipidea/otg_fsm.h | 6 + 3 files changed, 211 insertions(+), 0 deletions(-) diff --git a/drivers/usb/chipidea/otg.c b/drivers/usb/chipidea/otg.c index 5914c92..09099e5 100644 --- a/drivers/usb/chipidea/otg.c +++ b/drivers/usb/chipidea/otg.c @@ -129,4 +129,5 @@ void ci_hdrc_otg_destroy(struct ci_hdrc *ci) } ci_disable_otg_interrupt(ci, OTGSC_INT_EN_BITS); ci_clear_otg_interrupt(ci, OTGSC_INT_STATUS_BITS); + ci_hdrc_otg_fsm_remove(ci); } diff --git a/drivers/usb/chipidea/otg_fsm.c b/drivers/usb/chipidea/otg_fsm.c index 60465ab..8124a64 100644 --- a/drivers/usb/chipidea/otg_fsm.c +++ b/drivers/usb/chipidea/otg_fsm.c @@ -27,6 +27,7 @@ #include "otg_fsm.h" static struct list_head active_timers; +static struct ci_hdrc *ci_hdrc_p; #define HA_DATA_PULSE 1 @@ -51,6 +52,195 @@ inline struct ci_otg_fsm_timer *otg_timer_initializer 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 = ci_hdrc_p; + + next = buf; + size = PAGE_SIZE; + + if (ci->transceiver && ci->transceiver->otg && ci->fsm) { + t = scnprintf(next, size, "%d", ci->fsm->a_bus_req); + size -= t; + next += t; + } else + dev_err(ci->dev, "error: otg setup is not completed!\n"); + + 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 = ci_hdrc_p; + + if (count > 2) + return -1; + + mutex_lock(&ci->fsm->lock); + if (ci->transceiver && ci->transceiver->otg && ci->fsm) { + 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) + goto end; + ci->fsm->a_bus_req = 1; + if (ci->transceiver->state == OTG_STATE_A_PERIPHERAL) { + ci->gadget.host_request_flag = 1; + goto end; + } + } + + disable_irq_nosync(ci->irq); + queue_work(ci->wq, &ci->work); + } else + dev_err(ci->dev, "error: otg setup is not completed!\n"); +end: + 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 = ci_hdrc_p; + + next = buf; + size = PAGE_SIZE; + if (ci->transceiver && ci->transceiver->otg && ci->fsm) { + t = scnprintf(next, size, "%d", ci->fsm->a_bus_drop); + size -= t; + next += t; + } else + dev_err(ci->dev, "error: otg setup is not completed!\n"); + + 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 = ci_hdrc_p; + + if (count > 2) + return -1; + + mutex_lock(&ci->fsm->lock); + if (ci->transceiver && ci->transceiver->otg && ci->fsm) { + 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; + } + + disable_irq_nosync(ci->irq); + queue_work(ci->wq, &ci->work); + } + 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 = ci_hdrc_p; + + next = buf; + size = PAGE_SIZE; + + if (ci->transceiver && ci->transceiver->otg && ci->fsm) { + t = scnprintf(next, size, "%d", 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 = ci_hdrc_p; + + if (count > 2) + return -1; + + mutex_lock(&ci->fsm->lock); + if (ci->transceiver && ci->transceiver->otg && ci->fsm) { + if (buf[0] == '0') + ci->fsm->b_bus_req = 0; + else if (buf[0] == '1') { + ci->fsm->b_bus_req = 1; + if (ci->transceiver->state == OTG_STATE_B_PERIPHERAL) { + ci->gadget.host_request_flag = 1; + goto end; + } + } + + disable_irq_nosync(ci->irq); + queue_work(ci->wq, &ci->work); + } +end: + 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 = ci_hdrc_p; + + if (count > 2) + return -1; + + mutex_lock(&ci->fsm->lock); + if (ci->transceiver && ci->transceiver->otg && ci->fsm) { + if (buf[0] == '1') + ci->fsm->a_clr_err = 1; + + disable_irq_nosync(ci->irq); + queue_work(ci->wq, &ci->work); + } + 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 timer list */ void ci_otg_add_timer(struct ci_hdrc *ci, struct ci_otg_fsm_timer *gtimer) { @@ -764,6 +954,7 @@ int ci_hdrc_otg_fsm_init(struct ci_hdrc *ci) { int retval = 0; + ci_hdrc_p = ci; if (ci->transceiver == NULL) return -EPROBE_DEFER; @@ -803,6 +994,14 @@ int ci_hdrc_otg_fsm_init(struct ci_hdrc *ci) setup_timer(&ci->fsm->hnp_polling_timer, hnp_polling_timer_work, (unsigned long)ci); + + retval = sysfs_create_group(&ci->dev->kobj, &inputs_attr_group); + if (retval < 0) { + dev_dbg(ci->dev, + "Can't register sysfs attr group: %d\n", retval); + return retval; + } + /* enable ID and A vbus valid irq */ hw_write(ci, OP_OTGSC, OTGSC_INT_EN_BITS | OTGSC_INT_STATUS_BITS, OTGSC_IDIE | OTGSC_AVVIE); @@ -816,3 +1015,8 @@ int ci_hdrc_otg_fsm_init(struct ci_hdrc *ci) return 0; } + +void ci_hdrc_otg_fsm_remove(struct ci_hdrc *ci) +{ + sysfs_remove_group(&ci->dev->kobj, &inputs_attr_group); +} diff --git a/drivers/usb/chipidea/otg_fsm.h b/drivers/usb/chipidea/otg_fsm.h index 812efaa..a4b5792 100644 --- a/drivers/usb/chipidea/otg_fsm.h +++ b/drivers/usb/chipidea/otg_fsm.h @@ -93,6 +93,7 @@ int ci_hdrc_otg_fsm_init(struct ci_hdrc *ci); int ci_otg_fsm_work(struct ci_hdrc *ci); irqreturn_t ci_otg_fsm_irq(struct ci_hdrc *ci); void ci_hdrc_otg_fsm_start(struct ci_hdrc *ci); +void ci_hdrc_otg_fsm_remove(struct ci_hdrc *ci); #else @@ -116,6 +117,11 @@ static inline void ci_hdrc_otg_fsm_start(struct ci_hdrc *ci) } +static inline void ci_hdrc_otg_fsm_remove(struct ci_hdrc *ci) +{ + +} + #endif #endif /* __DRIVERS_USB_CHIPIDEA_OTG_FSM_H */ -- 1.7.8 -- To unsubscribe from this list: send the line "unsubscribe linux-usb" in the body of a message to [email protected] More majordomo info at http://vger.kernel.org/majordomo-info.html
