linux/drivers/usb/phy/phy-fsl-usb.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0+
   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.
   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>
  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
  32#include "phy-fsl-usb.h"
  33
  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
  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
  46static const char driver_name[] = "fsl-usb2-otg";
  47
  48const pm_message_t otg_suspend_state = {
  49        .event = 1,
  50};
  51
  52#define HA_DATA_PULSE
  53
  54static struct usb_dr_mmap *usb_dr_regs;
  55static struct fsl_otg *fsl_otg_dev;
  56static int srp_wait_done;
  57
  58/* FSM timers */
  59struct 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 */
  63struct 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
  66static struct list_head active_timers;
  67
  68static const struct fsl_otg_config fsl_otg_initdata = {
  69        .otg_port = 1,
  70};
  71
  72#ifdef CONFIG_PPC32
  73static u32 _fsl_readl_be(const unsigned __iomem *p)
  74{
  75        return in_be32(p);
  76}
  77
  78static u32 _fsl_readl_le(const unsigned __iomem *p)
  79{
  80        return in_le32(p);
  81}
  82
  83static void _fsl_writel_be(u32 v, unsigned __iomem *p)
  84{
  85        out_be32(p, v);
  86}
  87
  88static void _fsl_writel_le(u32 v, unsigned __iomem *p)
  89{
  90        out_le32(p, v);
  91}
  92
  93static u32 (*_fsl_readl)(const unsigned __iomem *p);
  94static 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
 104int 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 */
 117void fsl_otg_chrg_vbus(struct otg_fsm *fsm, int on)
 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 */
 135void 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 */
 153void fsl_otg_drv_vbus(struct otg_fsm *fsm, int on)
 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 */
 171void fsl_otg_loc_conn(struct otg_fsm *fsm, int on)
 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 */
 190void fsl_otg_loc_sof(struct otg_fsm *fsm, int on)
 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. */
 205void fsl_otg_start_pulse(struct otg_fsm *fsm)
 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
 218        fsl_otg_add_timer(fsm, b_data_pulse_tmr);
 219}
 220
 221void 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
 232void fsl_otg_pulse_vbus(void)
 233{
 234        srp_wait_done = 0;
 235        fsl_otg_chrg_vbus(&fsl_otg_dev->fsm, 1);
 236        /* start the timer to end vbus charge */
 237        fsl_otg_add_timer(&fsl_otg_dev->fsm, b_vbus_pulse_tmr);
 238}
 239
 240void b_vbus_pulse_end(unsigned long foo)
 241{
 242        fsl_otg_chrg_vbus(&fsl_otg_dev->fsm, 0);
 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);
 250        fsl_otg_add_timer(&fsl_otg_dev->fsm, b_srp_wait_tmr);
 251}
 252
 253void b_srp_end(unsigned long foo)
 254{
 255        fsl_otg_dischrg_vbus(0);
 256        srp_wait_done = 1;
 257
 258        if ((fsl_otg_dev->phy.otg->state == OTG_STATE_B_SRP_INIT) &&
 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 */
 268void a_wait_enum(unsigned long foo)
 269{
 270        VDBG("a_wait_enum timeout\n");
 271        if (!fsl_otg_dev->phy.otg->host->b_hnp_enable)
 272                fsl_otg_add_timer(&fsl_otg_dev->fsm, a_wait_enum_tmr);
 273        else
 274                otg_statemachine(&fsl_otg_dev->fsm);
 275}
 276
 277/* The timeout callback function to set time out bit */
 278void set_tmout(unsigned long indicator)
 279{
 280        *(int *)indicator = 1;
 281}
 282
 283/* Initialize timers */
 284int 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 */
 341void fsl_otg_uninit_timers(void)
 342{
 343        /* FSM used timers */
 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);
 351
 352        /* device driver used timers */
 353        kfree(b_srp_wait_tmr);
 354        kfree(b_data_pulse_tmr);
 355        kfree(b_vbus_pulse_tmr);
 356}
 357
 358static 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
 392/* Add timer to timer list */
 393void fsl_otg_add_timer(struct otg_fsm *fsm, void *gtimer)
 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
 411static 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
 422/* Remove timer from the timer list; clear timeout status */
 423void fsl_otg_del_timer(struct otg_fsm *fsm, void *gtimer)
 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
 433static 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
 444/* Reset controller, not reset the bus */
 445void 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 */
 457int fsl_otg_start_host(struct otg_fsm *fsm, int on)
 458{
 459        struct usb_otg *otg = fsm->otg;
 460        struct device *dev;
 461        struct fsl_otg *otg_dev =
 462                container_of(otg->usb_phy, struct fsl_otg, phy);
 463        u32 retval = 0;
 464
 465        if (!otg->host)
 466                return -ENODEV;
 467        dev = otg->host->controller;
 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 */
 486                                        fsl_otg_drv_vbus(fsm, 1);
 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 */
 511                                        fsl_otg_drv_vbus(fsm, 0);
 512                        }
 513                        otg_dev->host_working = 0;
 514                }
 515        }
 516end:
 517        return retval;
 518}
 519
 520/*
 521 * Call suspend and resume function in udc driver
 522 * to stop and start udc driver.
 523 */
 524int fsl_otg_start_gadget(struct otg_fsm *fsm, int on)
 525{
 526        struct usb_otg *otg = fsm->otg;
 527        struct device *dev;
 528
 529        if (!otg->gadget || !otg->gadget->dev.parent)
 530                return -ENODEV;
 531
 532        VDBG("gadget %s\n", on ? "on" : "off");
 533        dev = otg->gadget->dev.parent;
 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 */
 550static int fsl_otg_set_host(struct usb_otg *otg, struct usb_bus *host)
 551{
 552        struct fsl_otg *otg_dev;
 553
 554        if (!otg)
 555                return -ENODEV;
 556
 557        otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy);
 558        if (otg_dev != fsl_otg_dev)
 559                return -ENODEV;
 560
 561        otg->host = host;
 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
 569                otg->host->otg_port = fsl_otg_initdata.otg_port;
 570                otg->host->is_b_host = otg_dev->fsm.id;
 571                /*
 572                 * must leave time for hub_wq to finish its thing
 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
 586                        otg->state = OTG_STATE_UNDEFINED;
 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. */
 599static int fsl_otg_set_peripheral(struct usb_otg *otg,
 600                                        struct usb_gadget *gadget)
 601{
 602        struct fsl_otg *otg_dev;
 603
 604        if (!otg)
 605                return -ENODEV;
 606
 607        otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy);
 608        VDBG("otg_dev 0x%x\n", (int)otg_dev);
 609        VDBG("fsl_otg_dev 0x%x\n", (int)fsl_otg_dev);
 610        if (otg_dev != fsl_otg_dev)
 611                return -ENODEV;
 612
 613        if (!gadget) {
 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;
 618                otg_dev->fsm.b_bus_req = 0;
 619                otg_statemachine(&otg_dev->fsm);
 620                return 0;
 621        }
 622
 623        otg->gadget = gadget;
 624        otg->gadget->is_a_peripheral = !otg_dev->fsm.id;
 625
 626        otg_dev->fsm.b_bus_req = 1;
 627
 628        /* start the gadget right away if the ID pin says Mini-B */
 629        pr_debug("ID pin=%d\n", otg_dev->fsm.id);
 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
 639/*
 640 * Delayed pin detect interrupt processing.
 641 *
 642 * When the Mini-A cable is disconnected from the board,
 643 * the pin-detect interrupt happens before the disconnect
 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 */
 649static 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 */
 662static int fsl_otg_start_srp(struct usb_otg *otg)
 663{
 664        struct fsl_otg *otg_dev;
 665
 666        if (!otg || otg->state != OTG_STATE_B_IDLE)
 667                return -ENODEV;
 668
 669        otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy);
 670        if (otg_dev != fsl_otg_dev)
 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 */
 680static int fsl_otg_start_hnp(struct usb_otg *otg)
 681{
 682        struct fsl_otg *otg_dev;
 683
 684        if (!otg)
 685                return -ENODEV;
 686
 687        otg_dev = container_of(otg->usb_phy, struct fsl_otg, phy);
 688        if (otg_dev != fsl_otg_dev)
 689                return -ENODEV;
 690
 691        pr_debug("start_hnp...\n");
 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 */
 706irqreturn_t fsl_otg_isr(int irq, void *dev_id)
 707{
 708        struct otg_fsm *fsm = &((struct fsl_otg *)dev_id)->fsm;
 709        struct usb_otg *otg = ((struct fsl_otg *)dev_id)->phy.otg;
 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
 757static 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
 764        .add_timer = fsl_otg_fsm_add_timer,
 765        .del_timer = fsl_otg_fsm_del_timer,
 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 */
 772static 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
 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
 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        }
 799        mutex_init(&fsl_otg_tc->fsm.lock);
 800
 801        /* Set OTG state machine operations */
 802        fsl_otg_tc->fsm.ops = &fsl_otg_ops;
 803
 804        /* initialize the otg structure */
 805        fsl_otg_tc->phy.label = DRIVER_DESC;
 806        fsl_otg_tc->phy.dev = &pdev->dev;
 807
 808        fsl_otg_tc->phy.otg->usb_phy = &fsl_otg_tc->phy;
 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;
 813
 814        fsl_otg_dev = fsl_otg_tc;
 815
 816        /* Store the otg transceiver */
 817        status = usb_add_phy(&fsl_otg_tc->phy, USB_PHY_TYPE_USB2);
 818        if (status) {
 819                pr_warn(FSL_OTG_NAME ": unable to register OTG transceiver.\n");
 820                goto err;
 821        }
 822
 823        return 0;
 824err:
 825        fsl_otg_uninit_timers();
 826        kfree(fsl_otg_tc->phy.otg);
 827        kfree(fsl_otg_tc);
 828        return status;
 829}
 830
 831/* OTG Initialization */
 832int usb_otg_start(struct platform_device *pdev)
 833{
 834        struct fsl_otg *p_otg;
 835        struct usb_phy *otg_trans = usb_get_phy(USB_PHY_TYPE_USB2);
 836        struct otg_fsm *fsm;
 837        int status;
 838        struct resource *res;
 839        u32 temp;
 840        struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev);
 841
 842        p_otg = container_of(otg_trans, struct fsl_otg, phy);
 843        fsm = &p_otg->fsm;
 844
 845        /* Initialize the state machine structure with default values */
 846        SET_OTG_STATE(otg_trans, OTG_STATE_UNDEFINED);
 847        fsm->otg = p_otg->phy.otg;
 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
 864#ifdef CONFIG_PPC32
 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        }
 872#endif
 873
 874        /* request irq */
 875        p_otg->irq = platform_get_irq(pdev, 0);
 876        status = request_irq(p_otg->irq, fsl_otg_isr,
 877                                IRQF_SHARED, driver_name, p_otg);
 878        if (status) {
 879                dev_dbg(p_otg->phy.dev, "can't get IRQ %d, error %d\n",
 880                        p_otg->irq, status);
 881                iounmap(p_otg->dr_mem_map);
 882                kfree(p_otg->phy.otg);
 883                kfree(p_otg);
 884                return status;
 885        }
 886
 887        /* stop the controller */
 888        temp = fsl_readl(&p_otg->dr_mem_map->usbcmd);
 889        temp &= ~USB_CMD_RUN_STOP;
 890        fsl_writel(temp, &p_otg->dr_mem_map->usbcmd);
 891
 892        /* reset the controller */
 893        temp = fsl_readl(&p_otg->dr_mem_map->usbcmd);
 894        temp |= USB_CMD_CTRL_RESET;
 895        fsl_writel(temp, &p_otg->dr_mem_map->usbcmd);
 896
 897        /* wait reset completed */
 898        while (fsl_readl(&p_otg->dr_mem_map->usbcmd) & USB_CMD_CTRL_RESET)
 899                ;
 900
 901        /* configure the VBUSHS as IDLE(both host and device) */
 902        temp = USB_MODE_STREAM_DISABLE | (pdata->es ? USB_MODE_ES : 0);
 903        fsl_writel(temp, &p_otg->dr_mem_map->usbmode);
 904
 905        /* configure PHY interface */
 906        temp = fsl_readl(&p_otg->dr_mem_map->portsc);
 907        temp &= ~(PORTSC_PHY_TYPE_SEL | PORTSC_PTW);
 908        switch (pdata->phy_mode) {
 909        case FSL_USB2_PHY_ULPI:
 910                temp |= PORTSC_PTS_ULPI;
 911                break;
 912        case FSL_USB2_PHY_UTMI_WIDE:
 913                temp |= PORTSC_PTW_16BIT;
 914                fallthrough;
 915        case FSL_USB2_PHY_UTMI:
 916                temp |= PORTSC_PTS_UTMI;
 917                fallthrough;
 918        default:
 919                break;
 920        }
 921        fsl_writel(temp, &p_otg->dr_mem_map->portsc);
 922
 923        if (pdata->have_sysif_regs) {
 924                /* configure control enable IO output, big endian register */
 925                temp = __raw_readl(&p_otg->dr_mem_map->control);
 926                temp |= USB_CTRL_IOENB;
 927                __raw_writel(temp, &p_otg->dr_mem_map->control);
 928        }
 929
 930        /* disable all interrupt and clear all OTGSC status */
 931        temp = fsl_readl(&p_otg->dr_mem_map->otgsc);
 932        temp &= ~OTGSC_INTERRUPT_ENABLE_BITS_MASK;
 933        temp |= OTGSC_INTERRUPT_STATUS_BITS_MASK | OTGSC_CTRL_VBUS_DISCHARGE;
 934        fsl_writel(temp, &p_otg->dr_mem_map->otgsc);
 935
 936        /*
 937         * The identification (id) input is FALSE when a Mini-A plug is inserted
 938         * in the devices Mini-AB receptacle. Otherwise, this input is TRUE.
 939         * Also: record initial state of ID pin
 940         */
 941        if (fsl_readl(&p_otg->dr_mem_map->otgsc) & OTGSC_STS_USB_ID) {
 942                p_otg->phy.otg->state = OTG_STATE_UNDEFINED;
 943                p_otg->fsm.id = 1;
 944        } else {
 945                p_otg->phy.otg->state = OTG_STATE_A_IDLE;
 946                p_otg->fsm.id = 0;
 947        }
 948
 949        pr_debug("initial ID pin=%d\n", p_otg->fsm.id);
 950
 951        /* enable OTG ID pin interrupt */
 952        temp = fsl_readl(&p_otg->dr_mem_map->otgsc);
 953        temp |= OTGSC_INTR_USB_ID_EN;
 954        temp &= ~(OTGSC_CTRL_VBUS_DISCHARGE | OTGSC_INTR_1MS_TIMER_EN);
 955        fsl_writel(temp, &p_otg->dr_mem_map->otgsc);
 956
 957        return 0;
 958}
 959
 960static int fsl_otg_probe(struct platform_device *pdev)
 961{
 962        int ret;
 963
 964        if (!dev_get_platdata(&pdev->dev))
 965                return -ENODEV;
 966
 967        /* configure the OTG */
 968        ret = fsl_otg_conf(pdev);
 969        if (ret) {
 970                dev_err(&pdev->dev, "Couldn't configure OTG module\n");
 971                return ret;
 972        }
 973
 974        /* start OTG */
 975        ret = usb_otg_start(pdev);
 976        if (ret) {
 977                dev_err(&pdev->dev, "Can't init FSL OTG device\n");
 978                return ret;
 979        }
 980
 981        return ret;
 982}
 983
 984static int fsl_otg_remove(struct platform_device *pdev)
 985{
 986        struct fsl_usb2_platform_data *pdata = dev_get_platdata(&pdev->dev);
 987
 988        usb_remove_phy(&fsl_otg_dev->phy);
 989        free_irq(fsl_otg_dev->irq, fsl_otg_dev);
 990
 991        iounmap((void *)usb_dr_regs);
 992
 993        fsl_otg_uninit_timers();
 994        kfree(fsl_otg_dev->phy.otg);
 995        kfree(fsl_otg_dev);
 996
 997        if (pdata->exit)
 998                pdata->exit(pdev);
 999
1000        return 0;
1001}
1002
1003struct platform_driver fsl_otg_driver = {
1004        .probe = fsl_otg_probe,
1005        .remove = fsl_otg_remove,
1006        .driver = {
1007                .name = driver_name,
1008                .owner = THIS_MODULE,
1009        },
1010};
1011
1012module_platform_driver(fsl_otg_driver);
1013
1014MODULE_DESCRIPTION(DRIVER_INFO);
1015MODULE_AUTHOR(DRIVER_AUTHOR);
1016MODULE_LICENSE("GPL");
1017