// SPDX-License-Identifier: GPL-2.0+ /* * Copyright (C) 2007,2008 Freescale semiconductor, Inc. * * Author: Li Yang <LeoLi@freescale.com> * Jerry Huang <Chang-Ming.Huang@freescale.com> * * Initialization based on code from Shlomi Gridish. */ #include <linux/module.h> #include <linux/kernel.h> #include <linux/delay.h> #include <linux/slab.h> #include <linux/proc_fs.h> #include <linux/errno.h> #include <linux/interrupt.h> #include <linux/io.h> #include <linux/timer.h> #include <linux/usb.h> #include <linux/device.h> #include <linux/usb/ch9.h> #include <linux/usb/gadget.h> #include <linux/workqueue.h> #include <linux/time.h> #include <linux/fsl_devices.h> #include <linux/platform_device.h> #include <linux/uaccess.h> #include <asm/unaligned.h> #include "phy-fsl-usb.h" #ifdef VERBOSE #define VDBG(fmt, args...) pr_debug("[%s] " fmt, \ __func__, ## args) #else #define VDBG(stuff...) do {} while (0) #endif #define DRIVER_VERSION "Rev. 1.55" #define DRIVER_AUTHOR "Jerry Huang/Li Yang" #define DRIVER_DESC "Freescale USB OTG Transceiver Driver" #define DRIVER_INFO DRIVER_DESC " " DRIVER_VERSION static const char driver_name[] = "fsl-usb2-otg"; const pm_message_t otg_suspend_state = { .event = 1, }; #define HA_DATA_PULSE static struct usb_dr_mmap *usb_dr_regs; static struct fsl_otg *fsl_otg_dev; static int srp_wait_done; /* FSM timers */ struct fsl_otg_timer *a_wait_vrise_tmr, *a_wait_bcon_tmr, *a_aidl_bdis_tmr, *b_ase0_brst_tmr, *b_se0_srp_tmr; /* Driver specific timers */ struct fsl_otg_timer *b_data_pulse_tmr, *b_vbus_pulse_tmr, *b_srp_fail_tmr, *b_srp_wait_tmr, *a_wait_enum_tmr; static struct list_head active_timers; static const struct fsl_otg_config fsl_otg_initdata = { .otg_port = 1, }; #ifdef CONFIG_PPC32 static u32 _fsl_readl_be(const unsigned __iomem *p) { return in_be32(p); } static u32 _fsl_readl_le(const unsigned __iomem *p) { return in_le32(p); } static void _fsl_writel_be(u32 v, unsigned __iomem *p) { out_be32(p, v); } static void _fsl_writel_le(u32 v, unsigned __iomem *p) { out_le32(p, v); } static u32 (*_fsl_readl)(const unsigned __iomem *p); static void (*_fsl_writel)(u32 v, unsigned __iomem *p); #define fsl_readl(p) (*_fsl_readl)((p)) #define fsl_writel(v, p) (*_fsl_writel)((v), (p)) #else #define fsl_readl(addr) readl(addr) #define fsl_writel(val, addr) writel(val, addr) #endif /* CONFIG_PPC32 */ int write_ulpi(u8 addr, u8 data) { u32 temp; temp = 0x60000000 | (addr << 16) | data; fsl_writel(temp, &usb_dr_regs->ulpiview); return 0; } /* -------------------------------------------------------------*/ /* Operations that will be called from OTG Finite State Machine */ /* Charge vbus for vbus pulsing in SRP */ void fsl_otg_chrg_vbus(struct otg_fsm *fsm, int on) { u32 tmp; tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK; if (on) /* stop discharging, start charging */ tmp = (tmp & ~OTGSC_CTRL_VBUS_DISCHARGE) | OTGSC_CTRL_VBUS_CHARGE; else /* stop charging */ tmp &= ~OTGSC_CTRL_VBUS_CHARGE; fsl_writel(tmp, &usb_dr_regs->otgsc); } /* Discharge vbus through a resistor to ground */ void fsl_otg_dischrg_vbus(int on) { u32 tmp; tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK; if (on) /* stop charging, start discharging */ tmp = (tmp & ~OTGSC_CTRL_VBUS_CHARGE) | OTGSC_CTRL_VBUS_DISCHARGE; else /* stop discharging */ tmp &= ~OTGSC_CTRL_VBUS_DISCHARGE; fsl_writel(tmp, &usb_dr_regs->otgsc); } /* A-device driver vbus, controlled through PP bit in PORTSC */ void fsl_otg_drv_vbus(struct otg_fsm *fsm, int on) { u32 tmp; if (on) { tmp = fsl_readl(&usb_dr_regs->portsc) & ~PORTSC_W1C_BITS; fsl_writel(tmp | PORTSC_PORT_POWER, &usb_dr_regs->portsc); } else { tmp = fsl_readl(&usb_dr_regs->portsc) & ~PORTSC_W1C_BITS & ~PORTSC_PORT_POWER; fsl_writel(tmp, &usb_dr_regs->portsc); } } /* * Pull-up D+, signalling connect by periperal. Also used in * data-line pulsing in SRP */ void fsl_otg_loc_conn(struct otg_fsm *fsm, int on) { u32 tmp; tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK; if (on) tmp |= OTGSC_CTRL_DATA_PULSING; else tmp &= ~OTGSC_CTRL_DATA_PULSING; fsl_writel(tmp, &usb_dr_regs->otgsc); } /* * Generate SOF by host. This is controlled through suspend/resume the * port. In host mode, controller will automatically send SOF. * Suspend will block the data on the port. */ void fsl_otg_loc_sof(struct otg_fsm *fsm, int on) { u32 tmp; tmp = fsl_readl(&fsl_otg_dev->dr_mem_map->portsc) & ~PORTSC_W1C_BITS; if (on) tmp |= PORTSC_PORT_FORCE_RESUME; else tmp |= PORTSC_PORT_SUSPEND; fsl_writel(tmp, &fsl_otg_dev->dr_mem_map->portsc); } /* Start SRP pulsing by data-line pulsing, followed with v-bus pulsing. */ void fsl_otg_start_pulse(struct otg_fsm *fsm) { u32 tmp; srp_wait_done = 0; #ifdef HA_DATA_PULSE tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK; tmp |= OTGSC_HA_DATA_PULSE; fsl_writel(tmp, &usb_dr_regs->otgsc); #else fsl_otg_loc_conn(1); #endif fsl_otg_add_timer(fsm, b_data_pulse_tmr); } void b_data_pulse_end(unsigned long foo) { #ifdef HA_DATA_PULSE #else fsl_otg_loc_conn(0); #endif /* Do VBUS pulse after data pulse */ fsl_otg_pulse_vbus(); } void fsl_otg_pulse_vbus(void) { srp_wait_done = 0; fsl_otg_chrg_vbus(&fsl_otg_dev->fsm, 1); /* start the timer to end vbus charge */ fsl_otg_add_timer(&fsl_otg_dev->fsm, b_vbus_pulse_tmr); } void b_vbus_pulse_end(unsigned long foo) { fsl_otg_chrg_vbus(&fsl_otg_dev->fsm, 0); /* * As USB3300 using the same a_sess_vld and b_sess_vld voltage * we need to discharge the bus for a while to distinguish * residual voltage of vbus pulsing and A device pull up */ fsl_otg_dischrg_vbus(1); fsl_otg_add_timer(&fsl_otg_dev->fsm, b_srp_wait_tmr); } void b_srp_end(unsigned long foo) { fsl_otg_dischrg_vbus(0); srp_wait_done = 1; if ((fsl_otg_dev->phy.otg->state == OTG_STATE_B_SRP_INIT) && fsl_otg_dev->fsm.b_sess_vld) fsl_otg_dev->fsm.b_srp_done = 1; } /* * Workaround for a_host suspending too fast. When a_bus_req=0, * a_host will start by SRP. It needs to set b_hnp_enable before * actually suspending to start HNP */ void a_wait_enum(unsigned long foo) { VDBG("a_wait_enum timeout\n"); if (!fsl_otg_dev->phy.otg->host->b_hnp_enable) fsl_otg_add_timer(&fsl_otg_dev->fsm, a_wait_enum_tmr); else otg_statemachine(&fsl_otg_dev->fsm); } /* The timeout callback function to set time out bit */ void set_tmout(unsigned long indicator) { *(int *)indicator = 1; } /* Initialize timers */ int fsl_otg_init_timers(struct otg_fsm *fsm) { /* FSM used timers */ a_wait_vrise_tmr = otg_timer_initializer(&set_tmout, TA_WAIT_VRISE, (unsigned long)&fsm->a_wait_vrise_tmout); if (!a_wait_vrise_tmr) return -ENOMEM; a_wait_bcon_tmr = otg_timer_initializer(&set_tmout, TA_WAIT_BCON, (unsigned long)&fsm->a_wait_bcon_tmout); if (!a_wait_bcon_tmr) return -ENOMEM; a_aidl_bdis_tmr = otg_timer_initializer(&set_tmout, TA_AIDL_BDIS, (unsigned long)&fsm->a_aidl_bdis_tmout); if (!a_aidl_bdis_tmr) return -ENOMEM; b_ase0_brst_tmr = otg_timer_initializer(&set_tmout, TB_ASE0_BRST, (unsigned long)&fsm->b_ase0_brst_tmout); if (!b_ase0_brst_tmr) return -ENOMEM; b_se0_srp_tmr = otg_timer_initializer(&set_tmout, TB_SE0_SRP, (unsigned long)&fsm->b_se0_srp); if (!b_se0_srp_tmr) return -ENOMEM; b_srp_fail_tmr = otg_timer_initializer(&set_tmout, TB_SRP_FAIL, (unsigned long)&fsm->b_srp_done); if (!b_srp_fail_tmr) return -ENOMEM; a_wait_enum_tmr = otg_timer_initializer(&a_wait_enum, 10, (unsigned long)&fsm); if (!a_wait_enum_tmr) return -ENOMEM; /* device driver used timers */ b_srp_wait_tmr = otg_timer_initializer(&b_srp_end, TB_SRP_WAIT, 0); if (!b_srp_wait_tmr) return -ENOMEM; b_data_pulse_tmr = otg_timer_initializer(&b_data_pulse_end, TB_DATA_PLS, 0); if (!b_data_pulse_tmr) return -ENOMEM; b_vbus_pulse_tmr = otg_timer_initializer(&b_vbus_pulse_end, TB_VBUS_PLS, 0); if (!b_vbus_pulse_tmr) return -ENOMEM; return 0; } /* Uninitialize timers */ void fsl_otg_uninit_timers(void) { /* FSM used timers */ kfree(a_wait_vrise_tmr); kfree(a_wait_bcon_tmr); kfree(a_aidl_bdis_tmr); kfree(b_ase0_brst_tmr); kfree(b_se0_srp_tmr); kfree(b_srp_fail_tmr); kfree(a_wait_enum_tmr); /* device driver used timers */ kfree(b_srp_wait_tmr); kfree(b_data_pulse_tmr); kfree(b_vbus_pulse_tmr); } static struct fsl_otg_timer *fsl_otg_get_timer(enum otg_fsm_timer t) { struct fsl_otg_timer *timer; /* REVISIT: use array of pointers to timers instead */ switch (t) { case A_WAIT_VRISE: timer = a_wait_vrise_tmr; break; case A_WAIT_BCON: timer = a_wait_vrise_tmr; break; case A_AIDL_BDIS: timer = a_wait_vrise_tmr; break; case B_ASE0_BRST: timer = a_wait_vrise_tmr; break; case B_SE0_SRP: timer = a_wait_vrise_tmr; break; case B_SRP_FAIL: timer = a_wait_vrise_tmr; break; case A_WAIT_ENUM: timer = a_wait_vrise_tmr; break; default: timer = NULL; } return timer; } /* Add timer to timer list */ void fsl_otg_add_timer(struct otg_fsm *fsm, void *gtimer) { struct fsl_otg_timer *timer = gtimer; struct fsl_otg_timer *tmp_timer; /* * 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); } static void fsl_otg_fsm_add_timer(struct otg_fsm *fsm, enum otg_fsm_timer t) { struct fsl_otg_timer *timer; timer = fsl_otg_get_timer(t); if (!timer) return; fsl_otg_add_timer(fsm, timer); } /* Remove timer from the timer list; clear timeout status */ void fsl_otg_del_timer(struct otg_fsm *fsm, void *gtimer) { struct fsl_otg_timer *timer = gtimer; struct fsl_otg_timer *tmp_timer, *del_tmp; list_for_each_entry_safe(tmp_timer, del_tmp, &active_timers, list) if (tmp_timer == timer) list_del(&timer->list); } static void fsl_otg_fsm_del_timer(struct otg_fsm *fsm, enum otg_fsm_timer t) { struct fsl_otg_timer *timer; timer = fsl_otg_get_timer(t); if (!timer) return; fsl_otg_del_timer(fsm, timer); } /* Reset controller, not reset the bus */ void otg_reset_controller(void) { u32 command; command = fsl_readl(&usb_dr_regs->usbcmd); command |= (1 << 1); fsl_writel(command, &usb_dr_regs->usbcmd); while (fsl_readl(&usb_dr_regs->usbcmd) & (1 << 1)) ; } /* Call suspend/resume routines in host driver */ int fsl_otg_start_host(struct otg_fsm *fsm, int on) { struct usb_otg *otg = fsm->otg; struct device *dev; struct fsl_otg *otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy); u32 retval = 0; if (!otg->host) return -ENODEV; dev = otg->host->controller; /* * Update a_vbus_vld state as a_vbus_vld int is disabled * in device mode */ fsm->a_vbus_vld = !!(fsl_readl(&usb_dr_regs->otgsc) & OTGSC_STS_A_VBUS_VALID); if (on) { /* start fsl usb host controller */ if (otg_dev->host_working) goto end; else { otg_reset_controller(); VDBG("host on......\n"); if (dev->driver->pm && dev->driver->pm->resume) { retval = dev->driver->pm->resume(dev); if (fsm->id) { /* default-b */ fsl_otg_drv_vbus(fsm, 1); /* * Workaround: b_host can't driver * vbus, but PP in PORTSC needs to * be 1 for host to work. * So we set drv_vbus bit in * transceiver to 0 thru ULPI. */ write_ulpi(0x0c, 0x20); } } otg_dev->host_working = 1; } } else { /* stop fsl usb host controller */ if (!otg_dev->host_working) goto end; else { VDBG("host off......\n"); if (dev && dev->driver) { if (dev->driver->pm && dev->driver->pm->suspend) retval = dev->driver->pm->suspend(dev); if (fsm->id) /* default-b */ fsl_otg_drv_vbus(fsm, 0); } otg_dev->host_working = 0; } } end: return retval; } /* * Call suspend and resume function in udc driver * to stop and start udc driver. */ int fsl_otg_start_gadget(struct otg_fsm *fsm, int on) { struct usb_otg *otg = fsm->otg; struct device *dev; if (!otg->gadget || !otg->gadget->dev.parent) return -ENODEV; VDBG("gadget %s\n", on ? "on" : "off"); dev = otg->gadget->dev.parent; if (on) { if (dev->driver->resume) dev->driver->resume(dev); } else { if (dev->driver->suspend) dev->driver->suspend(dev, otg_suspend_state); } return 0; } /* * Called by initialization code of host driver. Register host controller * to the OTG. Suspend host for OTG role detection. */ static int fsl_otg_set_host(struct usb_otg *otg, struct usb_bus *host) { struct fsl_otg *otg_dev; if (!otg) return -ENODEV; otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy); if (otg_dev != fsl_otg_dev) return -ENODEV; otg->host = host; otg_dev->fsm.a_bus_drop = 0; otg_dev->fsm.a_bus_req = 1; if (host) { VDBG("host off......\n"); otg->host->otg_port = fsl_otg_initdata.otg_port; otg->host->is_b_host = otg_dev->fsm.id; /* * must leave time for hub_wq to finish its thing * before yanking the host driver out from under it, * so suspend the host after a short delay. */ otg_dev->host_working = 1; schedule_delayed_work(&otg_dev->otg_event, 100); return 0; } else { /* host driver going away */ if (!(fsl_readl(&otg_dev->dr_mem_map->otgsc) & OTGSC_STS_USB_ID)) { /* Mini-A cable connected */ struct otg_fsm *fsm = &otg_dev->fsm; otg->state = OTG_STATE_UNDEFINED; fsm->protocol = PROTO_UNDEF; } } otg_dev->host_working = 0; otg_statemachine(&otg_dev->fsm); return 0; } /* Called by initialization code of udc. Register udc to OTG. */ static int fsl_otg_set_peripheral(struct usb_otg *otg, struct usb_gadget *gadget) { struct fsl_otg *otg_dev; if (!otg) return -ENODEV; otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy); VDBG("otg_dev 0x%x\n", (int)otg_dev); VDBG("fsl_otg_dev 0x%x\n", (int)fsl_otg_dev); if (otg_dev != fsl_otg_dev) return -ENODEV; if (!gadget) { if (!otg->default_a) otg->gadget->ops->vbus_draw(otg->gadget, 0); usb_gadget_vbus_disconnect(otg->gadget); otg->gadget = 0; otg_dev->fsm.b_bus_req = 0; otg_statemachine(&otg_dev->fsm); return 0; } otg->gadget = gadget; otg->gadget->is_a_peripheral = !otg_dev->fsm.id; otg_dev->fsm.b_bus_req = 1; /* start the gadget right away if the ID pin says Mini-B */ pr_debug("ID pin=%d\n", otg_dev->fsm.id); if (otg_dev->fsm.id == 1) { fsl_otg_start_host(&otg_dev->fsm, 0); otg_drv_vbus(&otg_dev->fsm, 0); fsl_otg_start_gadget(&otg_dev->fsm, 1); } return 0; } /* * Delayed pin detect interrupt processing. * * When the Mini-A cable is disconnected from the board, * the pin-detect interrupt happens before the disconnect * interrupts for the connected device(s). In order to * process the disconnect interrupt(s) prior to switching * roles, the pin-detect interrupts are delayed, and handled * by this routine. */ static void fsl_otg_event(struct work_struct *work) { struct fsl_otg *og = container_of(work, struct fsl_otg, otg_event.work); struct otg_fsm *fsm = &og->fsm; if (fsm->id) { /* switch to gadget */ fsl_otg_start_host(fsm, 0); otg_drv_vbus(fsm, 0); fsl_otg_start_gadget(fsm, 1); } } /* B-device start SRP */ static int fsl_otg_start_srp(struct usb_otg *otg) { struct fsl_otg *otg_dev; if (!otg || otg->state != OTG_STATE_B_IDLE) return -ENODEV; otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy); if (otg_dev != fsl_otg_dev) return -ENODEV; otg_dev->fsm.b_bus_req = 1; otg_statemachine(&otg_dev->fsm); return 0; } /* A_host suspend will call this function to start hnp */ static int fsl_otg_start_hnp(struct usb_otg *otg) { struct fsl_otg *otg_dev; if (!otg) return -ENODEV; otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy); if (otg_dev != fsl_otg_dev) return -ENODEV; pr_debug("start_hnp...\n"); /* clear a_bus_req to enter a_suspend state */ otg_dev->fsm.a_bus_req = 0; otg_statemachine(&otg_dev->fsm); return 0; } /* * Interrupt handler. OTG/host/peripheral share the same int line. * OTG driver clears OTGSC interrupts and leaves USB interrupts * intact. It needs to have knowledge of some USB interrupts * such as port change. */ irqreturn_t fsl_otg_isr(int irq, void *dev_id) { struct otg_fsm *fsm = &((struct fsl_otg *)dev_id)->fsm; struct usb_otg *otg = ((struct fsl_otg *)dev_id)->phy.otg; u32 otg_int_src, otg_sc; otg_sc = fsl_readl(&usb_dr_regs->otgsc); otg_int_src = otg_sc & OTGSC_INTSTS_MASK & (otg_sc >> 8); /* Only clear otg interrupts */ fsl_writel(otg_sc, &usb_dr_regs->otgsc); /*FIXME: ID change not generate when init to 0 */ fsm->id = (otg_sc & OTGSC_STS_USB_ID) ? 1 : 0; otg->default_a = (fsm->id == 0); /* process OTG interrupts */ if (otg_int_src) { if (otg_int_src & OTGSC_INTSTS_USB_ID) { fsm->id = (otg_sc & OTGSC_STS_USB_ID) ? 1 : 0; otg->default_a = (fsm->id == 0); /* clear conn information */ if (fsm->id) fsm->b_conn = 0; else fsm->a_conn = 0; if (otg->host) otg->host->is_b_host = fsm->id; if (otg->gadget) otg->gadget->is_a_peripheral = !fsm->id; VDBG("ID int (ID is %d)\n", fsm->id); if (fsm->id) { /* switch to gadget */ schedule_delayed_work( &((struct fsl_otg *)dev_id)->otg_event, 100); } else { /* switch to host */ cancel_delayed_work(& ((struct fsl_otg *)dev_id)-> otg_event); fsl_otg_start_gadget(fsm, 0); otg_drv_vbus(fsm, 1); fsl_otg_start_host(fsm, 1); } return IRQ_HANDLED; } } return IRQ_NONE; } static struct otg_fsm_ops fsl_otg_ops = { .chrg_vbus = fsl_otg_chrg_vbus, .drv_vbus = fsl_otg_drv_vbus, .loc_conn = fsl_otg_loc_conn, .loc_sof = fsl_otg_loc_sof, .start_pulse = fsl_otg_start_pulse, .add_timer = fsl_otg_fsm_add_timer, .del_timer = fsl_otg_fsm_del_timer, .start_host = fsl_otg_start_host, .start_gadget = fsl_otg_start_gadget, }; /* Initialize the global variable fsl_otg_dev and request IRQ for OTG */ static int fsl_otg_conf(struct platform_device *pdev) { struct fsl_otg *fsl_otg_tc; int status; if (fsl_otg_dev) return 0; /* allocate space to fsl otg device */ fsl_otg_tc = kzalloc(sizeof(struct fsl_otg), GFP_KERNEL); if (!fsl_otg_tc) return -ENOMEM; fsl_otg_tc->phy.otg = kzalloc(sizeof(struct usb_otg), GFP_KERNEL); if (!fsl_otg_tc->phy.otg) { kfree(fsl_otg_tc); return -ENOMEM; } INIT_DELAYED_WORK(&fsl_otg_tc->otg_event, fsl_otg_event); INIT_LIST_HEAD(&active_timers); status = fsl_otg_init_timers(&fsl_otg_tc->fsm); if (status) { pr_info("Couldn't init OTG timers\n"); goto err; } mutex_init(&fsl_otg_tc->fsm.lock); /* Set OTG state machine operations */ fsl_otg_tc->fsm.ops = &fsl_otg_ops; /* initialize the otg structure */ fsl_otg_tc->phy.label = DRIVER_DESC; fsl_otg_tc->phy.dev = &pdev->dev; fsl_otg_tc->phy.otg->usb_phy = &fsl_otg_tc->phy; fsl_otg_tc->phy.otg->set_host = fsl_otg_set_host; fsl_otg_tc->phy.otg->set_peripheral = fsl_otg_set_peripheral; fsl_otg_tc->phy.otg->start_hnp = fsl_otg_start_hnp; fsl_otg_tc->phy.otg->start_srp = fsl_otg_start_srp; fsl_otg_dev = fsl_otg_tc; /* Store the otg transceiver */ status = usb_add_phy(&fsl_otg_tc->phy, USB_PHY_TYPE_USB2); if (status) { pr_warn(FSL_OTG_NAME ": unable to register OTG transceiver.\n"); goto err; } return 0; err: fsl_otg_uninit_timers(); kfree(fsl_otg_tc->phy.otg); kfree(fsl_otg_tc); return status; } /* OTG Initialization */ int usb_otg_start(struct platform_device *pdev) { struct fsl_otg *p_otg; struct usb_phy *otg_trans = usb_get_phy(USB_PHY_TYPE_USB2); struct otg_fsm *fsm; int status; struct resource *res; u32 temp; struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev); p_otg = container_of(otg_trans, struct fsl_otg, phy); fsm = &p_otg->fsm; /* Initialize the state machine structure with default values */ SET_OTG_STATE(otg_trans, OTG_STATE_UNDEFINED); fsm->otg = p_otg->phy.otg; /* We don't require predefined MEM/IRQ resource index */ res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!res) return -ENXIO; /* We don't request_mem_region here to enable resource sharing * with host/device */ usb_dr_regs = ioremap(res->start, sizeof(struct usb_dr_mmap)); p_otg->dr_mem_map = (struct usb_dr_mmap *)usb_dr_regs; pdata->regs = (void *)usb_dr_regs; if (pdata->init && pdata->init(pdev) != 0) return -EINVAL; #ifdef CONFIG_PPC32 if (pdata->big_endian_mmio) { _fsl_readl = _fsl_readl_be; _fsl_writel = _fsl_writel_be; } else { _fsl_readl = _fsl_readl_le; _fsl_writel = _fsl_writel_le; } #endif /* request irq */ p_otg->irq = platform_get_irq(pdev, 0); if (p_otg->irq < 0) return p_otg->irq; status = request_irq(p_otg->irq, fsl_otg_isr, IRQF_SHARED, driver_name, p_otg); if (status) { dev_dbg(p_otg->phy.dev, "can't get IRQ %d, error %d\n", p_otg->irq, status); iounmap(p_otg->dr_mem_map); kfree(p_otg->phy.otg); kfree(p_otg); return status; } /* stop the controller */ temp = fsl_readl(&p_otg->dr_mem_map->usbcmd); temp &= ~USB_CMD_RUN_STOP; fsl_writel(temp, &p_otg->dr_mem_map->usbcmd); /* reset the controller */ temp = fsl_readl(&p_otg->dr_mem_map->usbcmd); temp |= USB_CMD_CTRL_RESET; fsl_writel(temp, &p_otg->dr_mem_map->usbcmd); /* wait reset completed */ while (fsl_readl(&p_otg->dr_mem_map->usbcmd) & USB_CMD_CTRL_RESET) ; /* configure the VBUSHS as IDLE(both host and device) */ temp = USB_MODE_STREAM_DISABLE | (pdata->es ? USB_MODE_ES : 0); fsl_writel(temp, &p_otg->dr_mem_map->usbmode); /* configure PHY interface */ temp = fsl_readl(&p_otg->dr_mem_map->portsc); temp &= ~(PORTSC_PHY_TYPE_SEL | PORTSC_PTW); switch (pdata->phy_mode) { case FSL_USB2_PHY_ULPI: temp |= PORTSC_PTS_ULPI; break; case FSL_USB2_PHY_UTMI_WIDE: temp |= PORTSC_PTW_16BIT; fallthrough; case FSL_USB2_PHY_UTMI: temp |= PORTSC_PTS_UTMI; fallthrough; default: break; } fsl_writel(temp, &p_otg->dr_mem_map->portsc); if (pdata->have_sysif_regs) { /* configure control enable IO output, big endian register */ temp = __raw_readl(&p_otg->dr_mem_map->control); temp |= USB_CTRL_IOENB; __raw_writel(temp, &p_otg->dr_mem_map->control); } /* disable all interrupt and clear all OTGSC status */ temp = fsl_readl(&p_otg->dr_mem_map->otgsc); temp &= ~OTGSC_INTERRUPT_ENABLE_BITS_MASK; temp |= OTGSC_INTERRUPT_STATUS_BITS_MASK | OTGSC_CTRL_VBUS_DISCHARGE; fsl_writel(temp, &p_otg->dr_mem_map->otgsc); /* * The identification (id) input is FALSE when a Mini-A plug is inserted * in the devices Mini-AB receptacle. Otherwise, this input is TRUE. * Also: record initial state of ID pin */ if (fsl_readl(&p_otg->dr_mem_map->otgsc) & OTGSC_STS_USB_ID) { p_otg->phy.otg->state = OTG_STATE_UNDEFINED; p_otg->fsm.id = 1; } else { p_otg->phy.otg->state = OTG_STATE_A_IDLE; p_otg->fsm.id = 0; } pr_debug("initial ID pin=%d\n", p_otg->fsm.id); /* enable OTG ID pin interrupt */ temp = fsl_readl(&p_otg->dr_mem_map->otgsc); temp |= OTGSC_INTR_USB_ID_EN; temp &= ~(OTGSC_CTRL_VBUS_DISCHARGE | OTGSC_INTR_1MS_TIMER_EN); fsl_writel(temp, &p_otg->dr_mem_map->otgsc); return 0; } static int fsl_otg_probe(struct platform_device *pdev) { int ret; if (!dev_get_platdata(&pdev->dev)) return -ENODEV; /* configure the OTG */ ret = fsl_otg_conf(pdev); if (ret) { dev_err(&pdev->dev, "Couldn't configure OTG module\n"); return ret; } /* start OTG */ ret = usb_otg_start(pdev); if (ret) { dev_err(&pdev->dev, "Can't init FSL OTG device\n"); return ret; } return ret; } static void fsl_otg_remove(struct platform_device *pdev) { struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev); usb_remove_phy(&fsl_otg_dev->phy); free_irq(fsl_otg_dev->irq, fsl_otg_dev); iounmap((void *)usb_dr_regs); fsl_otg_uninit_timers(); kfree(fsl_otg_dev->phy.otg); kfree(fsl_otg_dev); if (pdata->exit) pdata->exit(pdev); } struct platform_driver fsl_otg_driver = { .probe = fsl_otg_probe, .remove_new = fsl_otg_remove, .driver = { .name = driver_name, .owner = THIS_MODULE, }, }; module_platform_driver(fsl_otg_driver); MODULE_DESCRIPTION(DRIVER_INFO); MODULE_AUTHOR(DRIVER_AUTHOR); MODULE_LICENSE("GPL");