drivers/net/dsa/b53/b53_srab.c

   1 /*
   2  * B53 register access through Switch Register Access Bridge Registers
   3  *
   4  * Copyright (C) 2013 Hauke Mehrtens <hauke@hauke-m.de>
   5  *
   6  * Permission to use, copy, modify, and/or distribute this software for any
   7  * purpose with or without fee is hereby granted, provided that the above
   8  * copyright notice and this permission notice appear in all copies.
   9  *
  10  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  11  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  12  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  13  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  14  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  15  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  16  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  17  */
  18
  19 #include <linux/kernel.h>
  20 #include <linux/module.h>
  21 #include <linux/delay.h>
  22 #include <linux/interrupt.h>
  23 #include <linux/platform_device.h>
  24 #include <linux/platform_data/b53.h>
  25 #include <linux/of.h>
  26
  27 #include "b53_priv.h"
  28 #include "b53_serdes.h"
  29
  30 /* command and status register of the SRAB */
  31 #define B53_SRAB_CMDSTAT                0x2c
  32 #define  B53_SRAB_CMDSTAT_RST           BIT(2)
  33 #define  B53_SRAB_CMDSTAT_WRITE         BIT(1)
  34 #define  B53_SRAB_CMDSTAT_GORDYN        BIT(0)
  35 #define  B53_SRAB_CMDSTAT_PAGE          24
  36 #define  B53_SRAB_CMDSTAT_REG           16
  37
  38 /* high order word of write data to switch registe */
  39 #define B53_SRAB_WD_H                   0x30
  40
  41 /* low order word of write data to switch registe */
  42 #define B53_SRAB_WD_L                   0x34
  43
  44 /* high order word of read data from switch register */
  45 #define B53_SRAB_RD_H                   0x38
  46
  47 /* low order word of read data from switch register */
  48 #define B53_SRAB_RD_L                   0x3c
  49
  50 /* command and status register of the SRAB */
  51 #define B53_SRAB_CTRLS                  0x40
  52 #define  B53_SRAB_CTRLS_HOST_INTR       BIT(1)
  53 #define  B53_SRAB_CTRLS_RCAREQ          BIT(3)
  54 #define  B53_SRAB_CTRLS_RCAGNT          BIT(4)
  55 #define  B53_SRAB_CTRLS_SW_INIT_DONE    BIT(6)
  56
  57 /* the register captures interrupt pulses from the switch */
  58 #define B53_SRAB_INTR                   0x44
  59 #define  B53_SRAB_INTR_P(x)             BIT(x)
  60 #define  B53_SRAB_SWITCH_PHY            BIT(8)
  61 #define  B53_SRAB_1588_SYNC             BIT(9)
  62 #define  B53_SRAB_IMP1_SLEEP_TIMER      BIT(10)
  63 #define  B53_SRAB_P7_SLEEP_TIMER        BIT(11)
  64 #define  B53_SRAB_IMP0_SLEEP_TIMER      BIT(12)
  65
  66 /* Port mux configuration registers */
  67 #define B53_MUX_CONFIG_P5               0x00
  68 #define  MUX_CONFIG_SGMII               0
  69 #define  MUX_CONFIG_MII_LITE            1
  70 #define  MUX_CONFIG_RGMII               2
  71 #define  MUX_CONFIG_GMII                3
  72 #define  MUX_CONFIG_GPHY                4
  73 #define  MUX_CONFIG_INTERNAL            5
  74 #define  MUX_CONFIG_MASK                0x7
  75 #define B53_MUX_CONFIG_P4               0x04
  76
  77 struct b53_srab_port_priv {
  78         int irq;
  79         bool irq_enabled;
  80         struct b53_device *dev;
  81         unsigned int num;
  82         phy_interface_t mode;
  83 };
  84
  85 struct b53_srab_priv {
  86         void __iomem *regs;
  87         void __iomem *mux_config;
  88         struct b53_srab_port_priv port_intrs[B53_N_PORTS];
  89 };
  90
  91 static int b53_srab_request_grant(struct b53_device *dev)
  92 {
  93         struct b53_srab_priv *priv = dev->priv;
  94         u8 __iomem *regs = priv->regs;
  95         u32 ctrls;
  96         int i;
  97
  98         ctrls = readl(regs + B53_SRAB_CTRLS);
  99         ctrls |= B53_SRAB_CTRLS_RCAREQ;
 100         writel(ctrls, regs + B53_SRAB_CTRLS);
 101
 102         for (i = 0; i < 20; i++) {
 103                 ctrls = readl(regs + B53_SRAB_CTRLS);
 104                 if (ctrls & B53_SRAB_CTRLS_RCAGNT)
 105                         break;
 106                 usleep_range(10, 100);
 107         }
 108         if (WARN_ON(i == 5))
 109                 return -EIO;
 110
 111         return 0;
 112 }
 113
 114 static void b53_srab_release_grant(struct b53_device *dev)
 115 {
 116         struct b53_srab_priv *priv = dev->priv;
 117         u8 __iomem *regs = priv->regs;
 118         u32 ctrls;
 119
 120         ctrls = readl(regs + B53_SRAB_CTRLS);
 121         ctrls &= ~B53_SRAB_CTRLS_RCAREQ;
 122         writel(ctrls, regs + B53_SRAB_CTRLS);
 123 }
 124
 125 static int b53_srab_op(struct b53_device *dev, u8 page, u8 reg, u32 op)
 126 {
 127         struct b53_srab_priv *priv = dev->priv;
 128         u8 __iomem *regs = priv->regs;
 129         int i;
 130         u32 cmdstat;
 131
 132         /* set register address */
 133         cmdstat = (page << B53_SRAB_CMDSTAT_PAGE) |
 134                   (reg << B53_SRAB_CMDSTAT_REG) |
 135                   B53_SRAB_CMDSTAT_GORDYN |
 136                   op;
 137         writel(cmdstat, regs + B53_SRAB_CMDSTAT);
 138
 139         /* check if operation completed */
 140         for (i = 0; i < 5; ++i) {
 141                 cmdstat = readl(regs + B53_SRAB_CMDSTAT);
 142                 if (!(cmdstat & B53_SRAB_CMDSTAT_GORDYN))
 143                         break;
 144                 usleep_range(10, 100);
 145         }
 146
 147         if (WARN_ON(i == 5))
 148                 return -EIO;
 149
 150         return 0;
 151 }
 152
 153 static int b53_srab_read8(struct b53_device *dev, u8 page, u8 reg, u8 *val)
 154 {
 155         struct b53_srab_priv *priv = dev->priv;
 156         u8 __iomem *regs = priv->regs;
 157         int ret = 0;
 158
 159         ret = b53_srab_request_grant(dev);
 160         if (ret)
 161                 goto err;
 162
 163         ret = b53_srab_op(dev, page, reg, 0);
 164         if (ret)
 165                 goto err;
 166
 167         *val = readl(regs + B53_SRAB_RD_L) & 0xff;
 168
 169 err:
 170         b53_srab_release_grant(dev);
 171
 172         return ret;
 173 }
 174
 175 static int b53_srab_read16(struct b53_device *dev, u8 page, u8 reg, u16 *val)
 176 {
 177         struct b53_srab_priv *priv = dev->priv;
 178         u8 __iomem *regs = priv->regs;
 179         int ret = 0;
 180
 181         ret = b53_srab_request_grant(dev);
 182         if (ret)
 183                 goto err;
 184
 185         ret = b53_srab_op(dev, page, reg, 0);
 186         if (ret)
 187                 goto err;
 188
 189         *val = readl(regs + B53_SRAB_RD_L) & 0xffff;
 190
 191 err:
 192         b53_srab_release_grant(dev);
 193
 194         return ret;
 195 }
 196
 197 static int b53_srab_read32(struct b53_device *dev, u8 page, u8 reg, u32 *val)
 198 {
 199         struct b53_srab_priv *priv = dev->priv;
 200         u8 __iomem *regs = priv->regs;
 201         int ret = 0;
 202
 203         ret = b53_srab_request_grant(dev);
 204         if (ret)
 205                 goto err;
 206
 207         ret = b53_srab_op(dev, page, reg, 0);
 208         if (ret)
 209                 goto err;
 210
 211         *val = readl(regs + B53_SRAB_RD_L);
 212
 213 err:
 214         b53_srab_release_grant(dev);
 215
 216         return ret;
 217 }
 218
 219 static int b53_srab_read48(struct b53_device *dev, u8 page, u8 reg, u64 *val)
 220 {
 221         struct b53_srab_priv *priv = dev->priv;
 222         u8 __iomem *regs = priv->regs;
 223         int ret = 0;
 224
 225         ret = b53_srab_request_grant(dev);
 226         if (ret)
 227                 goto err;
 228
 229         ret = b53_srab_op(dev, page, reg, 0);
 230         if (ret)
 231                 goto err;
 232
 233         *val = readl(regs + B53_SRAB_RD_L);
 234         *val += ((u64)readl(regs + B53_SRAB_RD_H) & 0xffff) << 32;
 235
 236 err:
 237         b53_srab_release_grant(dev);
 238
 239         return ret;
 240 }
 241
 242 static int b53_srab_read64(struct b53_device *dev, u8 page, u8 reg, u64 *val)
 243 {
 244         struct b53_srab_priv *priv = dev->priv;
 245         u8 __iomem *regs = priv->regs;
 246         int ret = 0;
 247
 248         ret = b53_srab_request_grant(dev);
 249         if (ret)
 250                 goto err;
 251
 252         ret = b53_srab_op(dev, page, reg, 0);
 253         if (ret)
 254                 goto err;
 255
 256         *val = readl(regs + B53_SRAB_RD_L);
 257         *val += (u64)readl(regs + B53_SRAB_RD_H) << 32;
 258
 259 err:
 260         b53_srab_release_grant(dev);
 261
 262         return ret;
 263 }
 264
 265 static int b53_srab_write8(struct b53_device *dev, u8 page, u8 reg, u8 value)
 266 {
 267         struct b53_srab_priv *priv = dev->priv;
 268         u8 __iomem *regs = priv->regs;
 269         int ret = 0;
 270
 271         ret = b53_srab_request_grant(dev);
 272         if (ret)
 273                 goto err;
 274
 275         writel(value, regs + B53_SRAB_WD_L);
 276
 277         ret = b53_srab_op(dev, page, reg, B53_SRAB_CMDSTAT_WRITE);
 278
 279 err:
 280         b53_srab_release_grant(dev);
 281
 282         return ret;
 283 }
 284
 285 static int b53_srab_write16(struct b53_device *dev, u8 page, u8 reg,
 286                             u16 value)
 287 {
 288         struct b53_srab_priv *priv = dev->priv;
 289         u8 __iomem *regs = priv->regs;
 290         int ret = 0;
 291
 292         ret = b53_srab_request_grant(dev);
 293         if (ret)
 294                 goto err;
 295
 296         writel(value, regs + B53_SRAB_WD_L);
 297
 298         ret = b53_srab_op(dev, page, reg, B53_SRAB_CMDSTAT_WRITE);
 299
 300 err:
 301         b53_srab_release_grant(dev);
 302
 303         return ret;
 304 }
 305
 306 static int b53_srab_write32(struct b53_device *dev, u8 page, u8 reg,
 307                             u32 value)
 308 {
 309         struct b53_srab_priv *priv = dev->priv;
 310         u8 __iomem *regs = priv->regs;
 311         int ret = 0;
 312
 313         ret = b53_srab_request_grant(dev);
 314         if (ret)
 315                 goto err;
 316
 317         writel(value, regs + B53_SRAB_WD_L);
 318
 319         ret = b53_srab_op(dev, page, reg, B53_SRAB_CMDSTAT_WRITE);
 320
 321 err:
 322         b53_srab_release_grant(dev);
 323
 324         return ret;
 325 }
 326
 327 static int b53_srab_write48(struct b53_device *dev, u8 page, u8 reg,
 328                             u64 value)
 329 {
 330         struct b53_srab_priv *priv = dev->priv;
 331         u8 __iomem *regs = priv->regs;
 332         int ret = 0;
 333
 334         ret = b53_srab_request_grant(dev);
 335         if (ret)
 336                 goto err;
 337
 338         writel((u32)value, regs + B53_SRAB_WD_L);
 339         writel((u16)(value >> 32), regs + B53_SRAB_WD_H);
 340
 341         ret = b53_srab_op(dev, page, reg, B53_SRAB_CMDSTAT_WRITE);
 342
 343 err:
 344         b53_srab_release_grant(dev);
 345
 346         return ret;
 347 }
 348
 349 static int b53_srab_write64(struct b53_device *dev, u8 page, u8 reg,
 350                             u64 value)
 351 {
 352         struct b53_srab_priv *priv = dev->priv;
 353         u8 __iomem *regs = priv->regs;
 354         int ret = 0;
 355
 356         ret = b53_srab_request_grant(dev);
 357         if (ret)
 358                 goto err;
 359
 360         writel((u32)value, regs + B53_SRAB_WD_L);
 361         writel((u32)(value >> 32), regs + B53_SRAB_WD_H);
 362
 363         ret = b53_srab_op(dev, page, reg, B53_SRAB_CMDSTAT_WRITE);
 364
 365 err:
 366         b53_srab_release_grant(dev);
 367
 368         return ret;
 369 }
 370
 371 static irqreturn_t b53_srab_port_thread(int irq, void *dev_id)
 372 {
 373         struct b53_srab_port_priv *port = dev_id;
 374         struct b53_device *dev = port->dev;
 375
 376         if (port->mode == PHY_INTERFACE_MODE_SGMII)
 377                 b53_port_event(dev->ds, port->num);
 378
 379         return IRQ_HANDLED;
 380 }
 381
 382 static irqreturn_t b53_srab_port_isr(int irq, void *dev_id)
 383 {
 384         struct b53_srab_port_priv *port = dev_id;
 385         struct b53_device *dev = port->dev;
 386         struct b53_srab_priv *priv = dev->priv;
 387
 388         /* Acknowledge the interrupt */
 389         writel(BIT(port->num), priv->regs + B53_SRAB_INTR);
 390
 391         return IRQ_WAKE_THREAD;
 392 }
 393
 394 #if IS_ENABLED(CONFIG_B53_SERDES)
 395 static u8 b53_srab_serdes_map_lane(struct b53_device *dev, int port)
 396 {
 397         struct b53_srab_priv *priv = dev->priv;
 398         struct b53_srab_port_priv *p = &priv->port_intrs[port];
 399
 400         if (p->mode != PHY_INTERFACE_MODE_SGMII)
 401                 return B53_INVALID_LANE;
 402
 403         switch (port) {
 404         case 5:
 405                 return 0;
 406         case 4:
 407                 return 1;
 408         default:
 409                 return B53_INVALID_LANE;
 410         }
 411 }
 412 #endif
 413
 414 static int b53_srab_irq_enable(struct b53_device *dev, int port)
 415 {
 416         struct b53_srab_priv *priv = dev->priv;
 417         struct b53_srab_port_priv *p = &priv->port_intrs[port];
 418         int ret = 0;
 419
 420         /* Interrupt is optional and was not specified, do not make
 421          * this fatal
 422          */
 423         if (p->irq == -ENXIO)
 424                 return ret;
 425
 426         ret = request_threaded_irq(p->irq, b53_srab_port_isr,
 427                                    b53_srab_port_thread, 0,
 428                                    dev_name(dev->dev), p);
 429         if (!ret)
 430                 p->irq_enabled = true;
 431
 432         return ret;
 433 }
 434
 435 static void b53_srab_irq_disable(struct b53_device *dev, int port)
 436 {
 437         struct b53_srab_priv *priv = dev->priv;
 438         struct b53_srab_port_priv *p = &priv->port_intrs[port];
 439
 440         if (p->irq_enabled) {
 441                 free_irq(p->irq, p);
 442                 p->irq_enabled = false;
 443         }
 444 }
 445
 446 static const struct b53_io_ops b53_srab_ops = {
 447         .read8 = b53_srab_read8,
 448         .read16 = b53_srab_read16,
 449         .read32 = b53_srab_read32,
 450         .read48 = b53_srab_read48,
 451         .read64 = b53_srab_read64,
 452         .write8 = b53_srab_write8,
 453         .write16 = b53_srab_write16,
 454         .write32 = b53_srab_write32,
 455         .write48 = b53_srab_write48,
 456         .write64 = b53_srab_write64,
 457         .irq_enable = b53_srab_irq_enable,
 458         .irq_disable = b53_srab_irq_disable,
 459 #if IS_ENABLED(CONFIG_B53_SERDES)
 460         .serdes_map_lane = b53_srab_serdes_map_lane,
 461         .serdes_link_state = b53_serdes_link_state,
 462         .serdes_config = b53_serdes_config,
 463         .serdes_an_restart = b53_serdes_an_restart,
 464         .serdes_link_set = b53_serdes_link_set,
 465         .serdes_phylink_validate = b53_serdes_phylink_validate,
 466 #endif
 467 };
 468
 469 static const struct of_device_id b53_srab_of_match[] = {
 470         { .compatible = "brcm,bcm53010-srab" },
 471         { .compatible = "brcm,bcm53011-srab" },
 472         { .compatible = "brcm,bcm53012-srab" },
 473         { .compatible = "brcm,bcm53018-srab" },
 474         { .compatible = "brcm,bcm53019-srab" },
 475         { .compatible = "brcm,bcm5301x-srab" },
 476         { .compatible = "brcm,bcm11360-srab", .data = (void *)BCM583XX_DEVICE_ID },
 477         { .compatible = "brcm,bcm58522-srab", .data = (void *)BCM58XX_DEVICE_ID },
 478         { .compatible = "brcm,bcm58525-srab", .data = (void *)BCM58XX_DEVICE_ID },
 479         { .compatible = "brcm,bcm58535-srab", .data = (void *)BCM58XX_DEVICE_ID },
 480         { .compatible = "brcm,bcm58622-srab", .data = (void *)BCM58XX_DEVICE_ID },
 481         { .compatible = "brcm,bcm58623-srab", .data = (void *)BCM58XX_DEVICE_ID },
 482         { .compatible = "brcm,bcm58625-srab", .data = (void *)BCM58XX_DEVICE_ID },
 483         { .compatible = "brcm,bcm88312-srab", .data = (void *)BCM58XX_DEVICE_ID },
 484         { .compatible = "brcm,cygnus-srab", .data = (void *)BCM583XX_DEVICE_ID },
 485         { .compatible = "brcm,nsp-srab", .data = (void *)BCM58XX_DEVICE_ID },
 486         { .compatible = "brcm,omega-srab", .data = (void *)BCM583XX_DEVICE_ID },
 487         { /* sentinel */ },
 488 };
 489 MODULE_DEVICE_TABLE(of, b53_srab_of_match);
 490
 491 static void b53_srab_intr_set(struct b53_srab_priv *priv, bool set)
 492 {
 493         u32 reg;
 494
 495         reg = readl(priv->regs + B53_SRAB_CTRLS);
 496         if (set)
 497                 reg |= B53_SRAB_CTRLS_HOST_INTR;
 498         else
 499                 reg &= ~B53_SRAB_CTRLS_HOST_INTR;
 500         writel(reg, priv->regs + B53_SRAB_CTRLS);
 501 }
 502
 503 static void b53_srab_prepare_irq(struct platform_device *pdev)
 504 {
 505         struct b53_device *dev = platform_get_drvdata(pdev);
 506         struct b53_srab_priv *priv = dev->priv;
 507         struct b53_srab_port_priv *port;
 508         unsigned int i;
 509         char *name;
 510
 511         /* Clear all pending interrupts */
 512         writel(0xffffffff, priv->regs + B53_SRAB_INTR);
 513
 514         if (dev->pdata && dev->pdata->chip_id != BCM58XX_DEVICE_ID)
 515                 return;
 516
 517         for (i = 0; i < B53_N_PORTS; i++) {
 518                 port = &priv->port_intrs[i];
 519
 520                 /* There is no port 6 */
 521                 if (i == 6)
 522                         continue;
 523
 524                 name = kasprintf(GFP_KERNEL, "link_state_p%d", i);
 525                 if (!name)
 526                         return;
 527
 528                 port->num = i;
 529                 port->dev = dev;
 530                 port->irq = platform_get_irq_byname(pdev, name);
 531                 kfree(name);
 532         }
 533
 534         b53_srab_intr_set(priv, true);
 535 }
 536
 537 static void b53_srab_mux_init(struct platform_device *pdev)
 538 {
 539         struct b53_device *dev = platform_get_drvdata(pdev);
 540         struct b53_srab_priv *priv = dev->priv;
 541         struct b53_srab_port_priv *p;
 542         struct resource *r;
 543         unsigned int port;
 544         u32 reg, off = 0;
 545         int ret;
 546
 547         if (dev->pdata && dev->pdata->chip_id != BCM58XX_DEVICE_ID)
 548                 return;
 549
 550         r = platform_get_resource(pdev, IORESOURCE_MEM, 1);
 551         priv->mux_config = devm_ioremap_resource(&pdev->dev, r);
 552         if (IS_ERR(priv->mux_config))
 553                 return;
 554
 555         /* Obtain the port mux configuration so we know which lanes
 556          * actually map to SerDes lanes
 557          */
 558         for (port = 5; port > 3; port--, off += 4) {
 559                 p = &priv->port_intrs[port];
 560
 561                 reg = readl(priv->mux_config + B53_MUX_CONFIG_P5 + off);
 562                 switch (reg & MUX_CONFIG_MASK) {
 563                 case MUX_CONFIG_SGMII:
 564                         p->mode = PHY_INTERFACE_MODE_SGMII;
 565                         ret = b53_serdes_init(dev, port);
 566                         if (ret)
 567                                 continue;
 568                         break;
 569                 case MUX_CONFIG_MII_LITE:
 570                         p->mode = PHY_INTERFACE_MODE_MII;
 571                         break;
 572                 case MUX_CONFIG_GMII:
 573                         p->mode = PHY_INTERFACE_MODE_GMII;
 574                         break;
 575                 case MUX_CONFIG_RGMII:
 576                         p->mode = PHY_INTERFACE_MODE_RGMII;
 577                         break;
 578                 case MUX_CONFIG_INTERNAL:
 579                         p->mode = PHY_INTERFACE_MODE_INTERNAL;
 580                         break;
 581                 default:
 582                         p->mode = PHY_INTERFACE_MODE_NA;
 583                         break;
 584                 }
 585
 586                 if (p->mode != PHY_INTERFACE_MODE_NA)
 587                         dev_info(&pdev->dev, "Port %d mode: %s\n",
 588                                  port, phy_modes(p->mode));
 589         }
 590 }
 591
 592 static int b53_srab_probe(struct platform_device *pdev)
 593 {
 594         struct b53_platform_data *pdata = pdev->dev.platform_data;
 595         struct device_node *dn = pdev->dev.of_node;
 596         const struct of_device_id *of_id = NULL;
 597         struct b53_srab_priv *priv;
 598         struct b53_device *dev;
 599         struct resource *r;
 600
 601         if (dn)
 602                 of_id = of_match_node(b53_srab_of_match, dn);
 603
 604         if (of_id) {
 605                 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
 606                 if (!pdata)
 607                         return -ENOMEM;
 608
 609                 pdata->chip_id = (u32)(unsigned long)of_id->data;
 610         }
 611
 612         priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
 613         if (!priv)
 614                 return -ENOMEM;
 615
 616         r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 617         priv->regs = devm_ioremap_resource(&pdev->dev, r);
 618         if (IS_ERR(priv->regs))
 619                 return -ENOMEM;
 620
 621         dev = b53_switch_alloc(&pdev->dev, &b53_srab_ops, priv);
 622         if (!dev)
 623                 return -ENOMEM;
 624
 625         if (pdata)
 626                 dev->pdata = pdata;
 627
 628         platform_set_drvdata(pdev, dev);
 629
 630         b53_srab_prepare_irq(pdev);
 631         b53_srab_mux_init(pdev);
 632
 633         return b53_switch_register(dev);
 634 }
 635
 636 static int b53_srab_remove(struct platform_device *pdev)
 637 {
 638         struct b53_device *dev = platform_get_drvdata(pdev);
 639         struct b53_srab_priv *priv = dev->priv;
 640
 641         b53_srab_intr_set(priv, false);
 642         if (dev)
 643                 b53_switch_remove(dev);
 644
 645         return 0;
 646 }
 647
 648 static struct platform_driver b53_srab_driver = {
 649         .probe = b53_srab_probe,
 650         .remove = b53_srab_remove,
 651         .driver = {
 652                 .name = "b53-srab-switch",
 653                 .of_match_table = b53_srab_of_match,
 654         },
 655 };
 656
 657 module_platform_driver(b53_srab_driver);
 658 MODULE_AUTHOR("Hauke Mehrtens <hauke@hauke-m.de>");
 659 MODULE_DESCRIPTION("B53 Switch Register Access Bridge Registers (SRAB) access driver");
 660 MODULE_LICENSE("Dual BSD/GPL");