Greg Kroah-Hartman | 5fd54ac | 2017-11-03 11:28:30 +0100 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 2 | /* |
| 3 | * Copyright (C) 2007,2008 Freescale semiconductor, Inc. |
| 4 | * |
| 5 | * Author: Li Yang <LeoLi@freescale.com> |
| 6 | * Jerry Huang <Chang-Ming.Huang@freescale.com> |
| 7 | * |
| 8 | * Initialization based on code from Shlomi Gridish. |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 9 | */ |
| 10 | |
| 11 | #include <linux/module.h> |
| 12 | #include <linux/kernel.h> |
| 13 | #include <linux/delay.h> |
| 14 | #include <linux/slab.h> |
| 15 | #include <linux/proc_fs.h> |
| 16 | #include <linux/errno.h> |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 17 | #include <linux/interrupt.h> |
| 18 | #include <linux/io.h> |
| 19 | #include <linux/timer.h> |
| 20 | #include <linux/usb.h> |
| 21 | #include <linux/device.h> |
| 22 | #include <linux/usb/ch9.h> |
| 23 | #include <linux/usb/gadget.h> |
| 24 | #include <linux/workqueue.h> |
| 25 | #include <linux/time.h> |
| 26 | #include <linux/fsl_devices.h> |
| 27 | #include <linux/platform_device.h> |
| 28 | #include <linux/uaccess.h> |
| 29 | |
| 30 | #include <asm/unaligned.h> |
| 31 | |
Felipe Balbi | 94ae984 | 2013-03-07 17:37:59 +0200 | [diff] [blame] | 32 | #include "phy-fsl-usb.h" |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 33 | |
Roger Quadros | e92634c | 2017-03-30 09:46:41 +0300 | [diff] [blame] | 34 | #ifdef VERBOSE |
| 35 | #define VDBG(fmt, args...) pr_debug("[%s] " fmt, \ |
| 36 | __func__, ## args) |
| 37 | #else |
| 38 | #define VDBG(stuff...) do {} while (0) |
| 39 | #endif |
| 40 | |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 41 | #define DRIVER_VERSION "Rev. 1.55" |
| 42 | #define DRIVER_AUTHOR "Jerry Huang/Li Yang" |
| 43 | #define DRIVER_DESC "Freescale USB OTG Transceiver Driver" |
| 44 | #define DRIVER_INFO DRIVER_DESC " " DRIVER_VERSION |
| 45 | |
| 46 | static const char driver_name[] = "fsl-usb2-otg"; |
| 47 | |
| 48 | const pm_message_t otg_suspend_state = { |
| 49 | .event = 1, |
| 50 | }; |
| 51 | |
| 52 | #define HA_DATA_PULSE |
| 53 | |
| 54 | static struct usb_dr_mmap *usb_dr_regs; |
| 55 | static struct fsl_otg *fsl_otg_dev; |
| 56 | static int srp_wait_done; |
| 57 | |
| 58 | /* FSM timers */ |
| 59 | struct fsl_otg_timer *a_wait_vrise_tmr, *a_wait_bcon_tmr, *a_aidl_bdis_tmr, |
| 60 | *b_ase0_brst_tmr, *b_se0_srp_tmr; |
| 61 | |
| 62 | /* Driver specific timers */ |
| 63 | struct fsl_otg_timer *b_data_pulse_tmr, *b_vbus_pulse_tmr, *b_srp_fail_tmr, |
| 64 | *b_srp_wait_tmr, *a_wait_enum_tmr; |
| 65 | |
| 66 | static struct list_head active_timers; |
| 67 | |
Nishka Dasgupta | f1b1900 | 2019-08-19 13:12:34 +0530 | [diff] [blame] | 68 | static const struct fsl_otg_config fsl_otg_initdata = { |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 69 | .otg_port = 1, |
| 70 | }; |
| 71 | |
| 72 | #ifdef CONFIG_PPC32 |
| 73 | static u32 _fsl_readl_be(const unsigned __iomem *p) |
| 74 | { |
| 75 | return in_be32(p); |
| 76 | } |
| 77 | |
| 78 | static u32 _fsl_readl_le(const unsigned __iomem *p) |
| 79 | { |
| 80 | return in_le32(p); |
| 81 | } |
| 82 | |
| 83 | static void _fsl_writel_be(u32 v, unsigned __iomem *p) |
| 84 | { |
| 85 | out_be32(p, v); |
| 86 | } |
| 87 | |
| 88 | static void _fsl_writel_le(u32 v, unsigned __iomem *p) |
| 89 | { |
| 90 | out_le32(p, v); |
| 91 | } |
| 92 | |
| 93 | static u32 (*_fsl_readl)(const unsigned __iomem *p); |
| 94 | static void (*_fsl_writel)(u32 v, unsigned __iomem *p); |
| 95 | |
| 96 | #define fsl_readl(p) (*_fsl_readl)((p)) |
| 97 | #define fsl_writel(v, p) (*_fsl_writel)((v), (p)) |
| 98 | |
| 99 | #else |
| 100 | #define fsl_readl(addr) readl(addr) |
| 101 | #define fsl_writel(val, addr) writel(val, addr) |
| 102 | #endif /* CONFIG_PPC32 */ |
| 103 | |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 104 | int write_ulpi(u8 addr, u8 data) |
| 105 | { |
| 106 | u32 temp; |
| 107 | |
| 108 | temp = 0x60000000 | (addr << 16) | data; |
| 109 | fsl_writel(temp, &usb_dr_regs->ulpiview); |
| 110 | return 0; |
| 111 | } |
| 112 | |
| 113 | /* -------------------------------------------------------------*/ |
| 114 | /* Operations that will be called from OTG Finite State Machine */ |
| 115 | |
| 116 | /* Charge vbus for vbus pulsing in SRP */ |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 117 | void fsl_otg_chrg_vbus(struct otg_fsm *fsm, int on) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 118 | { |
| 119 | u32 tmp; |
| 120 | |
| 121 | tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK; |
| 122 | |
| 123 | if (on) |
| 124 | /* stop discharging, start charging */ |
| 125 | tmp = (tmp & ~OTGSC_CTRL_VBUS_DISCHARGE) | |
| 126 | OTGSC_CTRL_VBUS_CHARGE; |
| 127 | else |
| 128 | /* stop charging */ |
| 129 | tmp &= ~OTGSC_CTRL_VBUS_CHARGE; |
| 130 | |
| 131 | fsl_writel(tmp, &usb_dr_regs->otgsc); |
| 132 | } |
| 133 | |
| 134 | /* Discharge vbus through a resistor to ground */ |
| 135 | void fsl_otg_dischrg_vbus(int on) |
| 136 | { |
| 137 | u32 tmp; |
| 138 | |
| 139 | tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK; |
| 140 | |
| 141 | if (on) |
| 142 | /* stop charging, start discharging */ |
| 143 | tmp = (tmp & ~OTGSC_CTRL_VBUS_CHARGE) | |
| 144 | OTGSC_CTRL_VBUS_DISCHARGE; |
| 145 | else |
| 146 | /* stop discharging */ |
| 147 | tmp &= ~OTGSC_CTRL_VBUS_DISCHARGE; |
| 148 | |
| 149 | fsl_writel(tmp, &usb_dr_regs->otgsc); |
| 150 | } |
| 151 | |
| 152 | /* A-device driver vbus, controlled through PP bit in PORTSC */ |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 153 | void fsl_otg_drv_vbus(struct otg_fsm *fsm, int on) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 154 | { |
| 155 | u32 tmp; |
| 156 | |
| 157 | if (on) { |
| 158 | tmp = fsl_readl(&usb_dr_regs->portsc) & ~PORTSC_W1C_BITS; |
| 159 | fsl_writel(tmp | PORTSC_PORT_POWER, &usb_dr_regs->portsc); |
| 160 | } else { |
| 161 | tmp = fsl_readl(&usb_dr_regs->portsc) & |
| 162 | ~PORTSC_W1C_BITS & ~PORTSC_PORT_POWER; |
| 163 | fsl_writel(tmp, &usb_dr_regs->portsc); |
| 164 | } |
| 165 | } |
| 166 | |
| 167 | /* |
| 168 | * Pull-up D+, signalling connect by periperal. Also used in |
| 169 | * data-line pulsing in SRP |
| 170 | */ |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 171 | void fsl_otg_loc_conn(struct otg_fsm *fsm, int on) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 172 | { |
| 173 | u32 tmp; |
| 174 | |
| 175 | tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK; |
| 176 | |
| 177 | if (on) |
| 178 | tmp |= OTGSC_CTRL_DATA_PULSING; |
| 179 | else |
| 180 | tmp &= ~OTGSC_CTRL_DATA_PULSING; |
| 181 | |
| 182 | fsl_writel(tmp, &usb_dr_regs->otgsc); |
| 183 | } |
| 184 | |
| 185 | /* |
| 186 | * Generate SOF by host. This is controlled through suspend/resume the |
| 187 | * port. In host mode, controller will automatically send SOF. |
| 188 | * Suspend will block the data on the port. |
| 189 | */ |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 190 | void fsl_otg_loc_sof(struct otg_fsm *fsm, int on) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 191 | { |
| 192 | u32 tmp; |
| 193 | |
| 194 | tmp = fsl_readl(&fsl_otg_dev->dr_mem_map->portsc) & ~PORTSC_W1C_BITS; |
| 195 | if (on) |
| 196 | tmp |= PORTSC_PORT_FORCE_RESUME; |
| 197 | else |
| 198 | tmp |= PORTSC_PORT_SUSPEND; |
| 199 | |
| 200 | fsl_writel(tmp, &fsl_otg_dev->dr_mem_map->portsc); |
| 201 | |
| 202 | } |
| 203 | |
| 204 | /* Start SRP pulsing by data-line pulsing, followed with v-bus pulsing. */ |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 205 | void fsl_otg_start_pulse(struct otg_fsm *fsm) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 206 | { |
| 207 | u32 tmp; |
| 208 | |
| 209 | srp_wait_done = 0; |
| 210 | #ifdef HA_DATA_PULSE |
| 211 | tmp = fsl_readl(&usb_dr_regs->otgsc) & ~OTGSC_INTSTS_MASK; |
| 212 | tmp |= OTGSC_HA_DATA_PULSE; |
| 213 | fsl_writel(tmp, &usb_dr_regs->otgsc); |
| 214 | #else |
| 215 | fsl_otg_loc_conn(1); |
| 216 | #endif |
| 217 | |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 218 | fsl_otg_add_timer(fsm, b_data_pulse_tmr); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 219 | } |
| 220 | |
| 221 | void b_data_pulse_end(unsigned long foo) |
| 222 | { |
| 223 | #ifdef HA_DATA_PULSE |
| 224 | #else |
| 225 | fsl_otg_loc_conn(0); |
| 226 | #endif |
| 227 | |
| 228 | /* Do VBUS pulse after data pulse */ |
| 229 | fsl_otg_pulse_vbus(); |
| 230 | } |
| 231 | |
| 232 | void fsl_otg_pulse_vbus(void) |
| 233 | { |
| 234 | srp_wait_done = 0; |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 235 | fsl_otg_chrg_vbus(&fsl_otg_dev->fsm, 1); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 236 | /* start the timer to end vbus charge */ |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 237 | fsl_otg_add_timer(&fsl_otg_dev->fsm, b_vbus_pulse_tmr); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 238 | } |
| 239 | |
| 240 | void b_vbus_pulse_end(unsigned long foo) |
| 241 | { |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 242 | fsl_otg_chrg_vbus(&fsl_otg_dev->fsm, 0); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 243 | |
| 244 | /* |
| 245 | * As USB3300 using the same a_sess_vld and b_sess_vld voltage |
| 246 | * we need to discharge the bus for a while to distinguish |
| 247 | * residual voltage of vbus pulsing and A device pull up |
| 248 | */ |
| 249 | fsl_otg_dischrg_vbus(1); |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 250 | fsl_otg_add_timer(&fsl_otg_dev->fsm, b_srp_wait_tmr); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 251 | } |
| 252 | |
| 253 | void b_srp_end(unsigned long foo) |
| 254 | { |
| 255 | fsl_otg_dischrg_vbus(0); |
| 256 | srp_wait_done = 1; |
| 257 | |
Felipe Balbi | e5ba1c0 | 2014-11-12 08:31:40 -0600 | [diff] [blame] | 258 | if ((fsl_otg_dev->phy.otg->state == OTG_STATE_B_SRP_INIT) && |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 259 | fsl_otg_dev->fsm.b_sess_vld) |
| 260 | fsl_otg_dev->fsm.b_srp_done = 1; |
| 261 | } |
| 262 | |
| 263 | /* |
| 264 | * Workaround for a_host suspending too fast. When a_bus_req=0, |
| 265 | * a_host will start by SRP. It needs to set b_hnp_enable before |
| 266 | * actually suspending to start HNP |
| 267 | */ |
| 268 | void a_wait_enum(unsigned long foo) |
| 269 | { |
| 270 | VDBG("a_wait_enum timeout\n"); |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 271 | if (!fsl_otg_dev->phy.otg->host->b_hnp_enable) |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 272 | fsl_otg_add_timer(&fsl_otg_dev->fsm, a_wait_enum_tmr); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 273 | else |
| 274 | otg_statemachine(&fsl_otg_dev->fsm); |
| 275 | } |
| 276 | |
| 277 | /* The timeout callback function to set time out bit */ |
| 278 | void set_tmout(unsigned long indicator) |
| 279 | { |
| 280 | *(int *)indicator = 1; |
| 281 | } |
| 282 | |
| 283 | /* Initialize timers */ |
| 284 | int fsl_otg_init_timers(struct otg_fsm *fsm) |
| 285 | { |
| 286 | /* FSM used timers */ |
| 287 | a_wait_vrise_tmr = otg_timer_initializer(&set_tmout, TA_WAIT_VRISE, |
| 288 | (unsigned long)&fsm->a_wait_vrise_tmout); |
| 289 | if (!a_wait_vrise_tmr) |
| 290 | return -ENOMEM; |
| 291 | |
| 292 | a_wait_bcon_tmr = otg_timer_initializer(&set_tmout, TA_WAIT_BCON, |
| 293 | (unsigned long)&fsm->a_wait_bcon_tmout); |
| 294 | if (!a_wait_bcon_tmr) |
| 295 | return -ENOMEM; |
| 296 | |
| 297 | a_aidl_bdis_tmr = otg_timer_initializer(&set_tmout, TA_AIDL_BDIS, |
| 298 | (unsigned long)&fsm->a_aidl_bdis_tmout); |
| 299 | if (!a_aidl_bdis_tmr) |
| 300 | return -ENOMEM; |
| 301 | |
| 302 | b_ase0_brst_tmr = otg_timer_initializer(&set_tmout, TB_ASE0_BRST, |
| 303 | (unsigned long)&fsm->b_ase0_brst_tmout); |
| 304 | if (!b_ase0_brst_tmr) |
| 305 | return -ENOMEM; |
| 306 | |
| 307 | b_se0_srp_tmr = otg_timer_initializer(&set_tmout, TB_SE0_SRP, |
| 308 | (unsigned long)&fsm->b_se0_srp); |
| 309 | if (!b_se0_srp_tmr) |
| 310 | return -ENOMEM; |
| 311 | |
| 312 | b_srp_fail_tmr = otg_timer_initializer(&set_tmout, TB_SRP_FAIL, |
| 313 | (unsigned long)&fsm->b_srp_done); |
| 314 | if (!b_srp_fail_tmr) |
| 315 | return -ENOMEM; |
| 316 | |
| 317 | a_wait_enum_tmr = otg_timer_initializer(&a_wait_enum, 10, |
| 318 | (unsigned long)&fsm); |
| 319 | if (!a_wait_enum_tmr) |
| 320 | return -ENOMEM; |
| 321 | |
| 322 | /* device driver used timers */ |
| 323 | b_srp_wait_tmr = otg_timer_initializer(&b_srp_end, TB_SRP_WAIT, 0); |
| 324 | if (!b_srp_wait_tmr) |
| 325 | return -ENOMEM; |
| 326 | |
| 327 | b_data_pulse_tmr = otg_timer_initializer(&b_data_pulse_end, |
| 328 | TB_DATA_PLS, 0); |
| 329 | if (!b_data_pulse_tmr) |
| 330 | return -ENOMEM; |
| 331 | |
| 332 | b_vbus_pulse_tmr = otg_timer_initializer(&b_vbus_pulse_end, |
| 333 | TB_VBUS_PLS, 0); |
| 334 | if (!b_vbus_pulse_tmr) |
| 335 | return -ENOMEM; |
| 336 | |
| 337 | return 0; |
| 338 | } |
| 339 | |
| 340 | /* Uninitialize timers */ |
| 341 | void fsl_otg_uninit_timers(void) |
| 342 | { |
| 343 | /* FSM used timers */ |
Syam Sidhardhan | 5f71791 | 2013-03-06 01:04:50 +0530 | [diff] [blame] | 344 | kfree(a_wait_vrise_tmr); |
| 345 | kfree(a_wait_bcon_tmr); |
| 346 | kfree(a_aidl_bdis_tmr); |
| 347 | kfree(b_ase0_brst_tmr); |
| 348 | kfree(b_se0_srp_tmr); |
| 349 | kfree(b_srp_fail_tmr); |
| 350 | kfree(a_wait_enum_tmr); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 351 | |
| 352 | /* device driver used timers */ |
Syam Sidhardhan | 5f71791 | 2013-03-06 01:04:50 +0530 | [diff] [blame] | 353 | kfree(b_srp_wait_tmr); |
| 354 | kfree(b_data_pulse_tmr); |
| 355 | kfree(b_vbus_pulse_tmr); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 356 | } |
| 357 | |
Anton Tikhomirov | f6de27e | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 358 | static struct fsl_otg_timer *fsl_otg_get_timer(enum otg_fsm_timer t) |
| 359 | { |
| 360 | struct fsl_otg_timer *timer; |
| 361 | |
| 362 | /* REVISIT: use array of pointers to timers instead */ |
| 363 | switch (t) { |
| 364 | case A_WAIT_VRISE: |
| 365 | timer = a_wait_vrise_tmr; |
| 366 | break; |
| 367 | case A_WAIT_BCON: |
| 368 | timer = a_wait_vrise_tmr; |
| 369 | break; |
| 370 | case A_AIDL_BDIS: |
| 371 | timer = a_wait_vrise_tmr; |
| 372 | break; |
| 373 | case B_ASE0_BRST: |
| 374 | timer = a_wait_vrise_tmr; |
| 375 | break; |
| 376 | case B_SE0_SRP: |
| 377 | timer = a_wait_vrise_tmr; |
| 378 | break; |
| 379 | case B_SRP_FAIL: |
| 380 | timer = a_wait_vrise_tmr; |
| 381 | break; |
| 382 | case A_WAIT_ENUM: |
| 383 | timer = a_wait_vrise_tmr; |
| 384 | break; |
| 385 | default: |
| 386 | timer = NULL; |
| 387 | } |
| 388 | |
| 389 | return timer; |
| 390 | } |
| 391 | |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 392 | /* Add timer to timer list */ |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 393 | void fsl_otg_add_timer(struct otg_fsm *fsm, void *gtimer) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 394 | { |
| 395 | struct fsl_otg_timer *timer = gtimer; |
| 396 | struct fsl_otg_timer *tmp_timer; |
| 397 | |
| 398 | /* |
| 399 | * Check if the timer is already in the active list, |
| 400 | * if so update timer count |
| 401 | */ |
| 402 | list_for_each_entry(tmp_timer, &active_timers, list) |
| 403 | if (tmp_timer == timer) { |
| 404 | timer->count = timer->expires; |
| 405 | return; |
| 406 | } |
| 407 | timer->count = timer->expires; |
| 408 | list_add_tail(&timer->list, &active_timers); |
| 409 | } |
| 410 | |
Anton Tikhomirov | f6de27e | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 411 | static void fsl_otg_fsm_add_timer(struct otg_fsm *fsm, enum otg_fsm_timer t) |
| 412 | { |
| 413 | struct fsl_otg_timer *timer; |
| 414 | |
| 415 | timer = fsl_otg_get_timer(t); |
| 416 | if (!timer) |
| 417 | return; |
| 418 | |
| 419 | fsl_otg_add_timer(fsm, timer); |
| 420 | } |
| 421 | |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 422 | /* Remove timer from the timer list; clear timeout status */ |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 423 | void fsl_otg_del_timer(struct otg_fsm *fsm, void *gtimer) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 424 | { |
| 425 | struct fsl_otg_timer *timer = gtimer; |
| 426 | struct fsl_otg_timer *tmp_timer, *del_tmp; |
| 427 | |
| 428 | list_for_each_entry_safe(tmp_timer, del_tmp, &active_timers, list) |
| 429 | if (tmp_timer == timer) |
| 430 | list_del(&timer->list); |
| 431 | } |
| 432 | |
Anton Tikhomirov | f6de27e | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 433 | static void fsl_otg_fsm_del_timer(struct otg_fsm *fsm, enum otg_fsm_timer t) |
| 434 | { |
| 435 | struct fsl_otg_timer *timer; |
| 436 | |
| 437 | timer = fsl_otg_get_timer(t); |
| 438 | if (!timer) |
| 439 | return; |
| 440 | |
| 441 | fsl_otg_del_timer(fsm, timer); |
| 442 | } |
| 443 | |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 444 | /* Reset controller, not reset the bus */ |
| 445 | void otg_reset_controller(void) |
| 446 | { |
| 447 | u32 command; |
| 448 | |
| 449 | command = fsl_readl(&usb_dr_regs->usbcmd); |
| 450 | command |= (1 << 1); |
| 451 | fsl_writel(command, &usb_dr_regs->usbcmd); |
| 452 | while (fsl_readl(&usb_dr_regs->usbcmd) & (1 << 1)) |
| 453 | ; |
| 454 | } |
| 455 | |
| 456 | /* Call suspend/resume routines in host driver */ |
| 457 | int fsl_otg_start_host(struct otg_fsm *fsm, int on) |
| 458 | { |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 459 | struct usb_otg *otg = fsm->otg; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 460 | struct device *dev; |
Antoine Tenart | 19c1eac | 2014-10-30 18:41:14 +0100 | [diff] [blame] | 461 | struct fsl_otg *otg_dev = |
| 462 | container_of(otg->usb_phy, struct fsl_otg, phy); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 463 | u32 retval = 0; |
| 464 | |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 465 | if (!otg->host) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 466 | return -ENODEV; |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 467 | dev = otg->host->controller; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 468 | |
| 469 | /* |
| 470 | * Update a_vbus_vld state as a_vbus_vld int is disabled |
| 471 | * in device mode |
| 472 | */ |
| 473 | fsm->a_vbus_vld = |
| 474 | !!(fsl_readl(&usb_dr_regs->otgsc) & OTGSC_STS_A_VBUS_VALID); |
| 475 | if (on) { |
| 476 | /* start fsl usb host controller */ |
| 477 | if (otg_dev->host_working) |
| 478 | goto end; |
| 479 | else { |
| 480 | otg_reset_controller(); |
| 481 | VDBG("host on......\n"); |
| 482 | if (dev->driver->pm && dev->driver->pm->resume) { |
| 483 | retval = dev->driver->pm->resume(dev); |
| 484 | if (fsm->id) { |
| 485 | /* default-b */ |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 486 | fsl_otg_drv_vbus(fsm, 1); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 487 | /* |
| 488 | * Workaround: b_host can't driver |
| 489 | * vbus, but PP in PORTSC needs to |
| 490 | * be 1 for host to work. |
| 491 | * So we set drv_vbus bit in |
| 492 | * transceiver to 0 thru ULPI. |
| 493 | */ |
| 494 | write_ulpi(0x0c, 0x20); |
| 495 | } |
| 496 | } |
| 497 | |
| 498 | otg_dev->host_working = 1; |
| 499 | } |
| 500 | } else { |
| 501 | /* stop fsl usb host controller */ |
| 502 | if (!otg_dev->host_working) |
| 503 | goto end; |
| 504 | else { |
| 505 | VDBG("host off......\n"); |
| 506 | if (dev && dev->driver) { |
| 507 | if (dev->driver->pm && dev->driver->pm->suspend) |
| 508 | retval = dev->driver->pm->suspend(dev); |
| 509 | if (fsm->id) |
| 510 | /* default-b */ |
Anton Tikhomirov | da8cc16 | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 511 | fsl_otg_drv_vbus(fsm, 0); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 512 | } |
| 513 | otg_dev->host_working = 0; |
| 514 | } |
| 515 | } |
| 516 | end: |
| 517 | return retval; |
| 518 | } |
| 519 | |
| 520 | /* |
| 521 | * Call suspend and resume function in udc driver |
| 522 | * to stop and start udc driver. |
| 523 | */ |
| 524 | int fsl_otg_start_gadget(struct otg_fsm *fsm, int on) |
| 525 | { |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 526 | struct usb_otg *otg = fsm->otg; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 527 | struct device *dev; |
| 528 | |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 529 | if (!otg->gadget || !otg->gadget->dev.parent) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 530 | return -ENODEV; |
| 531 | |
| 532 | VDBG("gadget %s\n", on ? "on" : "off"); |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 533 | dev = otg->gadget->dev.parent; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 534 | |
| 535 | if (on) { |
| 536 | if (dev->driver->resume) |
| 537 | dev->driver->resume(dev); |
| 538 | } else { |
| 539 | if (dev->driver->suspend) |
| 540 | dev->driver->suspend(dev, otg_suspend_state); |
| 541 | } |
| 542 | |
| 543 | return 0; |
| 544 | } |
| 545 | |
| 546 | /* |
| 547 | * Called by initialization code of host driver. Register host controller |
| 548 | * to the OTG. Suspend host for OTG role detection. |
| 549 | */ |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 550 | static int fsl_otg_set_host(struct usb_otg *otg, struct usb_bus *host) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 551 | { |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 552 | struct fsl_otg *otg_dev; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 553 | |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 554 | if (!otg) |
| 555 | return -ENODEV; |
| 556 | |
Antoine Tenart | 19c1eac | 2014-10-30 18:41:14 +0100 | [diff] [blame] | 557 | otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy); |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 558 | if (otg_dev != fsl_otg_dev) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 559 | return -ENODEV; |
| 560 | |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 561 | otg->host = host; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 562 | |
| 563 | otg_dev->fsm.a_bus_drop = 0; |
| 564 | otg_dev->fsm.a_bus_req = 1; |
| 565 | |
| 566 | if (host) { |
| 567 | VDBG("host off......\n"); |
| 568 | |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 569 | otg->host->otg_port = fsl_otg_initdata.otg_port; |
| 570 | otg->host->is_b_host = otg_dev->fsm.id; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 571 | /* |
Petr Mladek | 37ebb54 | 2014-09-19 17:32:23 +0200 | [diff] [blame] | 572 | * must leave time for hub_wq to finish its thing |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 573 | * before yanking the host driver out from under it, |
| 574 | * so suspend the host after a short delay. |
| 575 | */ |
| 576 | otg_dev->host_working = 1; |
| 577 | schedule_delayed_work(&otg_dev->otg_event, 100); |
| 578 | return 0; |
| 579 | } else { |
| 580 | /* host driver going away */ |
| 581 | if (!(fsl_readl(&otg_dev->dr_mem_map->otgsc) & |
| 582 | OTGSC_STS_USB_ID)) { |
| 583 | /* Mini-A cable connected */ |
| 584 | struct otg_fsm *fsm = &otg_dev->fsm; |
| 585 | |
Felipe Balbi | e5ba1c0 | 2014-11-12 08:31:40 -0600 | [diff] [blame] | 586 | otg->state = OTG_STATE_UNDEFINED; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 587 | fsm->protocol = PROTO_UNDEF; |
| 588 | } |
| 589 | } |
| 590 | |
| 591 | otg_dev->host_working = 0; |
| 592 | |
| 593 | otg_statemachine(&otg_dev->fsm); |
| 594 | |
| 595 | return 0; |
| 596 | } |
| 597 | |
| 598 | /* Called by initialization code of udc. Register udc to OTG. */ |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 599 | static int fsl_otg_set_peripheral(struct usb_otg *otg, |
| 600 | struct usb_gadget *gadget) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 601 | { |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 602 | struct fsl_otg *otg_dev; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 603 | |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 604 | if (!otg) |
| 605 | return -ENODEV; |
| 606 | |
Antoine Tenart | 19c1eac | 2014-10-30 18:41:14 +0100 | [diff] [blame] | 607 | otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 608 | VDBG("otg_dev 0x%x\n", (int)otg_dev); |
| 609 | VDBG("fsl_otg_dev 0x%x\n", (int)fsl_otg_dev); |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 610 | if (otg_dev != fsl_otg_dev) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 611 | return -ENODEV; |
| 612 | |
| 613 | if (!gadget) { |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 614 | if (!otg->default_a) |
| 615 | otg->gadget->ops->vbus_draw(otg->gadget, 0); |
| 616 | usb_gadget_vbus_disconnect(otg->gadget); |
| 617 | otg->gadget = 0; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 618 | otg_dev->fsm.b_bus_req = 0; |
| 619 | otg_statemachine(&otg_dev->fsm); |
| 620 | return 0; |
| 621 | } |
| 622 | |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 623 | otg->gadget = gadget; |
| 624 | otg->gadget->is_a_peripheral = !otg_dev->fsm.id; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 625 | |
| 626 | otg_dev->fsm.b_bus_req = 1; |
| 627 | |
| 628 | /* start the gadget right away if the ID pin says Mini-B */ |
Greg Kroah-Hartman | 523e531 | 2013-06-28 11:32:55 -0700 | [diff] [blame] | 629 | pr_debug("ID pin=%d\n", otg_dev->fsm.id); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 630 | if (otg_dev->fsm.id == 1) { |
| 631 | fsl_otg_start_host(&otg_dev->fsm, 0); |
| 632 | otg_drv_vbus(&otg_dev->fsm, 0); |
| 633 | fsl_otg_start_gadget(&otg_dev->fsm, 1); |
| 634 | } |
| 635 | |
| 636 | return 0; |
| 637 | } |
| 638 | |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 639 | /* |
| 640 | * Delayed pin detect interrupt processing. |
| 641 | * |
| 642 | * When the Mini-A cable is disconnected from the board, |
Justin P. Mattock | 42b2aa8 | 2011-11-28 20:31:00 -0800 | [diff] [blame] | 643 | * the pin-detect interrupt happens before the disconnect |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 644 | * interrupts for the connected device(s). In order to |
| 645 | * process the disconnect interrupt(s) prior to switching |
| 646 | * roles, the pin-detect interrupts are delayed, and handled |
| 647 | * by this routine. |
| 648 | */ |
| 649 | static void fsl_otg_event(struct work_struct *work) |
| 650 | { |
| 651 | struct fsl_otg *og = container_of(work, struct fsl_otg, otg_event.work); |
| 652 | struct otg_fsm *fsm = &og->fsm; |
| 653 | |
| 654 | if (fsm->id) { /* switch to gadget */ |
| 655 | fsl_otg_start_host(fsm, 0); |
| 656 | otg_drv_vbus(fsm, 0); |
| 657 | fsl_otg_start_gadget(fsm, 1); |
| 658 | } |
| 659 | } |
| 660 | |
| 661 | /* B-device start SRP */ |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 662 | static int fsl_otg_start_srp(struct usb_otg *otg) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 663 | { |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 664 | struct fsl_otg *otg_dev; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 665 | |
Felipe Balbi | e5ba1c0 | 2014-11-12 08:31:40 -0600 | [diff] [blame] | 666 | if (!otg || otg->state != OTG_STATE_B_IDLE) |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 667 | return -ENODEV; |
| 668 | |
Antoine Tenart | 19c1eac | 2014-10-30 18:41:14 +0100 | [diff] [blame] | 669 | otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy); |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 670 | if (otg_dev != fsl_otg_dev) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 671 | return -ENODEV; |
| 672 | |
| 673 | otg_dev->fsm.b_bus_req = 1; |
| 674 | otg_statemachine(&otg_dev->fsm); |
| 675 | |
| 676 | return 0; |
| 677 | } |
| 678 | |
| 679 | /* A_host suspend will call this function to start hnp */ |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 680 | static int fsl_otg_start_hnp(struct usb_otg *otg) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 681 | { |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 682 | struct fsl_otg *otg_dev; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 683 | |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 684 | if (!otg) |
| 685 | return -ENODEV; |
| 686 | |
Antoine Tenart | 19c1eac | 2014-10-30 18:41:14 +0100 | [diff] [blame] | 687 | otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy); |
Wei Yongjun | 58add6c | 2012-09-10 12:42:31 +0800 | [diff] [blame] | 688 | if (otg_dev != fsl_otg_dev) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 689 | return -ENODEV; |
| 690 | |
Greg Kroah-Hartman | 523e531 | 2013-06-28 11:32:55 -0700 | [diff] [blame] | 691 | pr_debug("start_hnp...\n"); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 692 | |
| 693 | /* clear a_bus_req to enter a_suspend state */ |
| 694 | otg_dev->fsm.a_bus_req = 0; |
| 695 | otg_statemachine(&otg_dev->fsm); |
| 696 | |
| 697 | return 0; |
| 698 | } |
| 699 | |
| 700 | /* |
| 701 | * Interrupt handler. OTG/host/peripheral share the same int line. |
| 702 | * OTG driver clears OTGSC interrupts and leaves USB interrupts |
| 703 | * intact. It needs to have knowledge of some USB interrupts |
| 704 | * such as port change. |
| 705 | */ |
| 706 | irqreturn_t fsl_otg_isr(int irq, void *dev_id) |
| 707 | { |
| 708 | struct otg_fsm *fsm = &((struct fsl_otg *)dev_id)->fsm; |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 709 | struct usb_otg *otg = ((struct fsl_otg *)dev_id)->phy.otg; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 710 | u32 otg_int_src, otg_sc; |
| 711 | |
| 712 | otg_sc = fsl_readl(&usb_dr_regs->otgsc); |
| 713 | otg_int_src = otg_sc & OTGSC_INTSTS_MASK & (otg_sc >> 8); |
| 714 | |
| 715 | /* Only clear otg interrupts */ |
| 716 | fsl_writel(otg_sc, &usb_dr_regs->otgsc); |
| 717 | |
| 718 | /*FIXME: ID change not generate when init to 0 */ |
| 719 | fsm->id = (otg_sc & OTGSC_STS_USB_ID) ? 1 : 0; |
| 720 | otg->default_a = (fsm->id == 0); |
| 721 | |
| 722 | /* process OTG interrupts */ |
| 723 | if (otg_int_src) { |
| 724 | if (otg_int_src & OTGSC_INTSTS_USB_ID) { |
| 725 | fsm->id = (otg_sc & OTGSC_STS_USB_ID) ? 1 : 0; |
| 726 | otg->default_a = (fsm->id == 0); |
| 727 | /* clear conn information */ |
| 728 | if (fsm->id) |
| 729 | fsm->b_conn = 0; |
| 730 | else |
| 731 | fsm->a_conn = 0; |
| 732 | |
| 733 | if (otg->host) |
| 734 | otg->host->is_b_host = fsm->id; |
| 735 | if (otg->gadget) |
| 736 | otg->gadget->is_a_peripheral = !fsm->id; |
| 737 | VDBG("ID int (ID is %d)\n", fsm->id); |
| 738 | |
| 739 | if (fsm->id) { /* switch to gadget */ |
| 740 | schedule_delayed_work( |
| 741 | &((struct fsl_otg *)dev_id)->otg_event, |
| 742 | 100); |
| 743 | } else { /* switch to host */ |
| 744 | cancel_delayed_work(& |
| 745 | ((struct fsl_otg *)dev_id)-> |
| 746 | otg_event); |
| 747 | fsl_otg_start_gadget(fsm, 0); |
| 748 | otg_drv_vbus(fsm, 1); |
| 749 | fsl_otg_start_host(fsm, 1); |
| 750 | } |
| 751 | return IRQ_HANDLED; |
| 752 | } |
| 753 | } |
| 754 | return IRQ_NONE; |
| 755 | } |
| 756 | |
| 757 | static struct otg_fsm_ops fsl_otg_ops = { |
| 758 | .chrg_vbus = fsl_otg_chrg_vbus, |
| 759 | .drv_vbus = fsl_otg_drv_vbus, |
| 760 | .loc_conn = fsl_otg_loc_conn, |
| 761 | .loc_sof = fsl_otg_loc_sof, |
| 762 | .start_pulse = fsl_otg_start_pulse, |
| 763 | |
Anton Tikhomirov | f6de27e | 2013-10-03 12:42:04 +0900 | [diff] [blame] | 764 | .add_timer = fsl_otg_fsm_add_timer, |
| 765 | .del_timer = fsl_otg_fsm_del_timer, |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 766 | |
| 767 | .start_host = fsl_otg_start_host, |
| 768 | .start_gadget = fsl_otg_start_gadget, |
| 769 | }; |
| 770 | |
| 771 | /* Initialize the global variable fsl_otg_dev and request IRQ for OTG */ |
| 772 | static int fsl_otg_conf(struct platform_device *pdev) |
| 773 | { |
| 774 | struct fsl_otg *fsl_otg_tc; |
| 775 | int status; |
| 776 | |
| 777 | if (fsl_otg_dev) |
| 778 | return 0; |
| 779 | |
| 780 | /* allocate space to fsl otg device */ |
| 781 | fsl_otg_tc = kzalloc(sizeof(struct fsl_otg), GFP_KERNEL); |
| 782 | if (!fsl_otg_tc) |
| 783 | return -ENOMEM; |
| 784 | |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 785 | fsl_otg_tc->phy.otg = kzalloc(sizeof(struct usb_otg), GFP_KERNEL); |
| 786 | if (!fsl_otg_tc->phy.otg) { |
| 787 | kfree(fsl_otg_tc); |
| 788 | return -ENOMEM; |
| 789 | } |
| 790 | |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 791 | INIT_DELAYED_WORK(&fsl_otg_tc->otg_event, fsl_otg_event); |
| 792 | |
| 793 | INIT_LIST_HEAD(&active_timers); |
| 794 | status = fsl_otg_init_timers(&fsl_otg_tc->fsm); |
| 795 | if (status) { |
| 796 | pr_info("Couldn't init OTG timers\n"); |
| 797 | goto err; |
| 798 | } |
Anton Tikhomirov | 16e569e | 2013-11-26 11:46:05 +0900 | [diff] [blame] | 799 | mutex_init(&fsl_otg_tc->fsm.lock); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 800 | |
| 801 | /* Set OTG state machine operations */ |
| 802 | fsl_otg_tc->fsm.ops = &fsl_otg_ops; |
| 803 | |
| 804 | /* initialize the otg structure */ |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 805 | fsl_otg_tc->phy.label = DRIVER_DESC; |
Robert Jarzmik | 1abd8b3 | 2013-05-10 15:15:08 +0530 | [diff] [blame] | 806 | fsl_otg_tc->phy.dev = &pdev->dev; |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 807 | |
Antoine Tenart | 19c1eac | 2014-10-30 18:41:14 +0100 | [diff] [blame] | 808 | fsl_otg_tc->phy.otg->usb_phy = &fsl_otg_tc->phy; |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 809 | fsl_otg_tc->phy.otg->set_host = fsl_otg_set_host; |
| 810 | fsl_otg_tc->phy.otg->set_peripheral = fsl_otg_set_peripheral; |
| 811 | fsl_otg_tc->phy.otg->start_hnp = fsl_otg_start_hnp; |
| 812 | fsl_otg_tc->phy.otg->start_srp = fsl_otg_start_srp; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 813 | |
| 814 | fsl_otg_dev = fsl_otg_tc; |
| 815 | |
| 816 | /* Store the otg transceiver */ |
Kishon Vijay Abraham I | 662dca5 | 2012-06-22 17:02:46 +0530 | [diff] [blame] | 817 | status = usb_add_phy(&fsl_otg_tc->phy, USB_PHY_TYPE_USB2); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 818 | if (status) { |
| 819 | pr_warn(FSL_OTG_NAME ": unable to register OTG transceiver.\n"); |
| 820 | goto err; |
| 821 | } |
| 822 | |
| 823 | return 0; |
| 824 | err: |
| 825 | fsl_otg_uninit_timers(); |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 826 | kfree(fsl_otg_tc->phy.otg); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 827 | kfree(fsl_otg_tc); |
| 828 | return status; |
| 829 | } |
| 830 | |
| 831 | /* OTG Initialization */ |
| 832 | int usb_otg_start(struct platform_device *pdev) |
| 833 | { |
| 834 | struct fsl_otg *p_otg; |
Kishon Vijay Abraham I | 662dca5 | 2012-06-22 17:02:46 +0530 | [diff] [blame] | 835 | struct usb_phy *otg_trans = usb_get_phy(USB_PHY_TYPE_USB2); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 836 | struct otg_fsm *fsm; |
| 837 | int status; |
| 838 | struct resource *res; |
| 839 | u32 temp; |
Jingoo Han | 19f9e18 | 2013-07-30 17:02:13 +0900 | [diff] [blame] | 840 | struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 841 | |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 842 | p_otg = container_of(otg_trans, struct fsl_otg, phy); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 843 | fsm = &p_otg->fsm; |
| 844 | |
| 845 | /* Initialize the state machine structure with default values */ |
| 846 | SET_OTG_STATE(otg_trans, OTG_STATE_UNDEFINED); |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 847 | fsm->otg = p_otg->phy.otg; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 848 | |
| 849 | /* We don't require predefined MEM/IRQ resource index */ |
| 850 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 851 | if (!res) |
| 852 | return -ENXIO; |
| 853 | |
| 854 | /* We don't request_mem_region here to enable resource sharing |
| 855 | * with host/device */ |
| 856 | |
| 857 | usb_dr_regs = ioremap(res->start, sizeof(struct usb_dr_mmap)); |
| 858 | p_otg->dr_mem_map = (struct usb_dr_mmap *)usb_dr_regs; |
| 859 | pdata->regs = (void *)usb_dr_regs; |
| 860 | |
| 861 | if (pdata->init && pdata->init(pdev) != 0) |
| 862 | return -EINVAL; |
| 863 | |
Randy Dunlap | a39ba90 | 2018-07-15 10:37:37 -0700 | [diff] [blame] | 864 | #ifdef CONFIG_PPC32 |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 865 | if (pdata->big_endian_mmio) { |
| 866 | _fsl_readl = _fsl_readl_be; |
| 867 | _fsl_writel = _fsl_writel_be; |
| 868 | } else { |
| 869 | _fsl_readl = _fsl_readl_le; |
| 870 | _fsl_writel = _fsl_writel_le; |
| 871 | } |
Randy Dunlap | a39ba90 | 2018-07-15 10:37:37 -0700 | [diff] [blame] | 872 | #endif |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 873 | |
| 874 | /* request irq */ |
| 875 | p_otg->irq = platform_get_irq(pdev, 0); |
Sergey Shtylyov | ecc2f30 | 2021-08-09 23:50:18 +0300 | [diff] [blame] | 876 | if (p_otg->irq < 0) |
| 877 | return p_otg->irq; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 878 | status = request_irq(p_otg->irq, fsl_otg_isr, |
| 879 | IRQF_SHARED, driver_name, p_otg); |
| 880 | if (status) { |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 881 | dev_dbg(p_otg->phy.dev, "can't get IRQ %d, error %d\n", |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 882 | p_otg->irq, status); |
| 883 | iounmap(p_otg->dr_mem_map); |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 884 | kfree(p_otg->phy.otg); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 885 | kfree(p_otg); |
| 886 | return status; |
| 887 | } |
| 888 | |
| 889 | /* stop the controller */ |
| 890 | temp = fsl_readl(&p_otg->dr_mem_map->usbcmd); |
| 891 | temp &= ~USB_CMD_RUN_STOP; |
| 892 | fsl_writel(temp, &p_otg->dr_mem_map->usbcmd); |
| 893 | |
| 894 | /* reset the controller */ |
| 895 | temp = fsl_readl(&p_otg->dr_mem_map->usbcmd); |
| 896 | temp |= USB_CMD_CTRL_RESET; |
| 897 | fsl_writel(temp, &p_otg->dr_mem_map->usbcmd); |
| 898 | |
| 899 | /* wait reset completed */ |
| 900 | while (fsl_readl(&p_otg->dr_mem_map->usbcmd) & USB_CMD_CTRL_RESET) |
| 901 | ; |
| 902 | |
| 903 | /* configure the VBUSHS as IDLE(both host and device) */ |
| 904 | temp = USB_MODE_STREAM_DISABLE | (pdata->es ? USB_MODE_ES : 0); |
| 905 | fsl_writel(temp, &p_otg->dr_mem_map->usbmode); |
| 906 | |
| 907 | /* configure PHY interface */ |
| 908 | temp = fsl_readl(&p_otg->dr_mem_map->portsc); |
| 909 | temp &= ~(PORTSC_PHY_TYPE_SEL | PORTSC_PTW); |
| 910 | switch (pdata->phy_mode) { |
| 911 | case FSL_USB2_PHY_ULPI: |
| 912 | temp |= PORTSC_PTS_ULPI; |
| 913 | break; |
| 914 | case FSL_USB2_PHY_UTMI_WIDE: |
| 915 | temp |= PORTSC_PTW_16BIT; |
Gustavo A. R. Silva | 4e71e07 | 2020-07-07 15:00:40 -0500 | [diff] [blame] | 916 | fallthrough; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 917 | case FSL_USB2_PHY_UTMI: |
| 918 | temp |= PORTSC_PTS_UTMI; |
Gustavo A. R. Silva | 4e71e07 | 2020-07-07 15:00:40 -0500 | [diff] [blame] | 919 | fallthrough; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 920 | default: |
| 921 | break; |
| 922 | } |
| 923 | fsl_writel(temp, &p_otg->dr_mem_map->portsc); |
| 924 | |
| 925 | if (pdata->have_sysif_regs) { |
| 926 | /* configure control enable IO output, big endian register */ |
| 927 | temp = __raw_readl(&p_otg->dr_mem_map->control); |
| 928 | temp |= USB_CTRL_IOENB; |
| 929 | __raw_writel(temp, &p_otg->dr_mem_map->control); |
| 930 | } |
| 931 | |
| 932 | /* disable all interrupt and clear all OTGSC status */ |
| 933 | temp = fsl_readl(&p_otg->dr_mem_map->otgsc); |
| 934 | temp &= ~OTGSC_INTERRUPT_ENABLE_BITS_MASK; |
| 935 | temp |= OTGSC_INTERRUPT_STATUS_BITS_MASK | OTGSC_CTRL_VBUS_DISCHARGE; |
| 936 | fsl_writel(temp, &p_otg->dr_mem_map->otgsc); |
| 937 | |
| 938 | /* |
| 939 | * The identification (id) input is FALSE when a Mini-A plug is inserted |
| 940 | * in the devices Mini-AB receptacle. Otherwise, this input is TRUE. |
| 941 | * Also: record initial state of ID pin |
| 942 | */ |
| 943 | if (fsl_readl(&p_otg->dr_mem_map->otgsc) & OTGSC_STS_USB_ID) { |
Felipe Balbi | e5ba1c0 | 2014-11-12 08:31:40 -0600 | [diff] [blame] | 944 | p_otg->phy.otg->state = OTG_STATE_UNDEFINED; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 945 | p_otg->fsm.id = 1; |
| 946 | } else { |
Felipe Balbi | e5ba1c0 | 2014-11-12 08:31:40 -0600 | [diff] [blame] | 947 | p_otg->phy.otg->state = OTG_STATE_A_IDLE; |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 948 | p_otg->fsm.id = 0; |
| 949 | } |
| 950 | |
Greg Kroah-Hartman | 523e531 | 2013-06-28 11:32:55 -0700 | [diff] [blame] | 951 | pr_debug("initial ID pin=%d\n", p_otg->fsm.id); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 952 | |
| 953 | /* enable OTG ID pin interrupt */ |
| 954 | temp = fsl_readl(&p_otg->dr_mem_map->otgsc); |
| 955 | temp |= OTGSC_INTR_USB_ID_EN; |
| 956 | temp &= ~(OTGSC_CTRL_VBUS_DISCHARGE | OTGSC_INTR_1MS_TIMER_EN); |
| 957 | fsl_writel(temp, &p_otg->dr_mem_map->otgsc); |
| 958 | |
| 959 | return 0; |
| 960 | } |
| 961 | |
Bill Pemberton | 41ac7b3 | 2012-11-19 13:21:48 -0500 | [diff] [blame] | 962 | static int fsl_otg_probe(struct platform_device *pdev) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 963 | { |
| 964 | int ret; |
| 965 | |
Jingoo Han | 19f9e18 | 2013-07-30 17:02:13 +0900 | [diff] [blame] | 966 | if (!dev_get_platdata(&pdev->dev)) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 967 | return -ENODEV; |
| 968 | |
| 969 | /* configure the OTG */ |
| 970 | ret = fsl_otg_conf(pdev); |
| 971 | if (ret) { |
| 972 | dev_err(&pdev->dev, "Couldn't configure OTG module\n"); |
| 973 | return ret; |
| 974 | } |
| 975 | |
| 976 | /* start OTG */ |
| 977 | ret = usb_otg_start(pdev); |
| 978 | if (ret) { |
| 979 | dev_err(&pdev->dev, "Can't init FSL OTG device\n"); |
| 980 | return ret; |
| 981 | } |
| 982 | |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 983 | return ret; |
| 984 | } |
| 985 | |
Bill Pemberton | fb4e98a | 2012-11-19 13:26:20 -0500 | [diff] [blame] | 986 | static int fsl_otg_remove(struct platform_device *pdev) |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 987 | { |
Jingoo Han | 19f9e18 | 2013-07-30 17:02:13 +0900 | [diff] [blame] | 988 | struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 989 | |
Kishon Vijay Abraham I | 662dca5 | 2012-06-22 17:02:46 +0530 | [diff] [blame] | 990 | usb_remove_phy(&fsl_otg_dev->phy); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 991 | free_irq(fsl_otg_dev->irq, fsl_otg_dev); |
| 992 | |
| 993 | iounmap((void *)usb_dr_regs); |
| 994 | |
| 995 | fsl_otg_uninit_timers(); |
Heikki Krogerus | 7e062c0 | 2012-02-13 13:24:06 +0200 | [diff] [blame] | 996 | kfree(fsl_otg_dev->phy.otg); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 997 | kfree(fsl_otg_dev); |
| 998 | |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 999 | if (pdata->exit) |
| 1000 | pdata->exit(pdev); |
| 1001 | |
| 1002 | return 0; |
| 1003 | } |
| 1004 | |
| 1005 | struct platform_driver fsl_otg_driver = { |
| 1006 | .probe = fsl_otg_probe, |
Bill Pemberton | 7690417 | 2012-11-19 13:21:08 -0500 | [diff] [blame] | 1007 | .remove = fsl_otg_remove, |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 1008 | .driver = { |
| 1009 | .name = driver_name, |
| 1010 | .owner = THIS_MODULE, |
| 1011 | }, |
| 1012 | }; |
| 1013 | |
Axel Lin | cc27c96 | 2011-11-27 20:16:27 +0800 | [diff] [blame] | 1014 | module_platform_driver(fsl_otg_driver); |
Li Yang | 0807c50 | 2011-04-18 22:01:59 +0200 | [diff] [blame] | 1015 | |
| 1016 | MODULE_DESCRIPTION(DRIVER_INFO); |
| 1017 | MODULE_AUTHOR(DRIVER_AUTHOR); |
| 1018 | MODULE_LICENSE("GPL"); |