drivers/remoteproc/qcom_wcnss.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Qualcomm Wireless Connectivity Subsystem Peripheral Image Loader
   4  *
   5  * Copyright (C) 2016 Linaro Ltd
   6  * Copyright (C) 2014 Sony Mobile Communications AB
   7  * Copyright (c) 2012-2013, The Linux Foundation. All rights reserved.
   8  */
   9
  10 #include <linux/clk.h>
  11 #include <linux/delay.h>
  12 #include <linux/firmware.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/kernel.h>
  15 #include <linux/module.h>
  16 #include <linux/io.h>
  17 #include <linux/of_address.h>
  18 #include <linux/of_device.h>
  19 #include <linux/platform_device.h>
  20 #include <linux/pm_domain.h>
  21 #include <linux/pm_runtime.h>
  22 #include <linux/firmware/qcom/qcom_scm.h>
  23 #include <linux/regulator/consumer.h>
  24 #include <linux/remoteproc.h>
  25 #include <linux/soc/qcom/mdt_loader.h>
  26 #include <linux/soc/qcom/smem.h>
  27 #include <linux/soc/qcom/smem_state.h>
  28
  29 #include "qcom_common.h"
  30 #include "remoteproc_internal.h"
  31 #include "qcom_pil_info.h"
  32 #include "qcom_wcnss.h"
  33
  34 #define WCNSS_CRASH_REASON_SMEM         422
  35 #define WCNSS_FIRMWARE_NAME             "wcnss.mdt"
  36 #define WCNSS_PAS_ID                    6
  37 #define WCNSS_SSCTL_ID                  0x13
  38
  39 #define WCNSS_SPARE_NVBIN_DLND          BIT(25)
  40
  41 #define WCNSS_PMU_IRIS_XO_CFG           BIT(3)
  42 #define WCNSS_PMU_IRIS_XO_EN            BIT(4)
  43 #define WCNSS_PMU_GC_BUS_MUX_SEL_TOP    BIT(5)
  44 #define WCNSS_PMU_IRIS_XO_CFG_STS       BIT(6) /* 1: in progress, 0: done */
  45
  46 #define WCNSS_PMU_IRIS_RESET            BIT(7)
  47 #define WCNSS_PMU_IRIS_RESET_STS        BIT(8) /* 1: in progress, 0: done */
  48 #define WCNSS_PMU_IRIS_XO_READ          BIT(9)
  49 #define WCNSS_PMU_IRIS_XO_READ_STS      BIT(10)
  50
  51 #define WCNSS_PMU_XO_MODE_MASK          GENMASK(2, 1)
  52 #define WCNSS_PMU_XO_MODE_19p2          0
  53 #define WCNSS_PMU_XO_MODE_48            3
  54
  55 #define WCNSS_MAX_PDS                   2
  56
  57 struct wcnss_data {
  58         size_t pmu_offset;
  59         size_t spare_offset;
  60
  61         const char *pd_names[WCNSS_MAX_PDS];
  62         const struct wcnss_vreg_info *vregs;
  63         size_t num_vregs, num_pd_vregs;
  64 };
  65
  66 struct qcom_wcnss {
  67         struct device *dev;
  68         struct rproc *rproc;
  69
  70         void __iomem *pmu_cfg;
  71         void __iomem *spare_out;
  72
  73         bool use_48mhz_xo;
  74
  75         int wdog_irq;
  76         int fatal_irq;
  77         int ready_irq;
  78         int handover_irq;
  79         int stop_ack_irq;
  80
  81         struct qcom_smem_state *state;
  82         unsigned stop_bit;
  83
  84         struct mutex iris_lock;
  85         struct qcom_iris *iris;
  86
  87         struct device *pds[WCNSS_MAX_PDS];
  88         size_t num_pds;
  89         struct regulator_bulk_data *vregs;
  90         size_t num_vregs;
  91
  92         struct completion start_done;
  93         struct completion stop_done;
  94
  95         phys_addr_t mem_phys;
  96         phys_addr_t mem_reloc;
  97         void *mem_region;
  98         size_t mem_size;
  99
 100         struct qcom_rproc_subdev smd_subdev;
 101         struct qcom_sysmon *sysmon;
 102 };
 103
 104 static const struct wcnss_data riva_data = {
 105         .pmu_offset = 0x28,
 106         .spare_offset = 0xb4,
 107
 108         .vregs = (struct wcnss_vreg_info[]) {
 109                 { "vddmx",  1050000, 1150000, 0 },
 110                 { "vddcx",  1050000, 1150000, 0 },
 111                 { "vddpx",  1800000, 1800000, 0 },
 112         },
 113         .num_vregs = 3,
 114 };
 115
 116 static const struct wcnss_data pronto_v1_data = {
 117         .pmu_offset = 0x1004,
 118         .spare_offset = 0x1088,
 119
 120         .pd_names = { "mx", "cx" },
 121         .vregs = (struct wcnss_vreg_info[]) {
 122                 { "vddmx", 950000, 1150000, 0 },
 123                 { "vddcx", .super_turbo = true},
 124                 { "vddpx", 1800000, 1800000, 0 },
 125         },
 126         .num_pd_vregs = 2,
 127         .num_vregs = 1,
 128 };
 129
 130 static const struct wcnss_data pronto_v2_data = {
 131         .pmu_offset = 0x1004,
 132         .spare_offset = 0x1088,
 133
 134         .pd_names = { "mx", "cx" },
 135         .vregs = (struct wcnss_vreg_info[]) {
 136                 { "vddmx", 1287500, 1287500, 0 },
 137                 { "vddcx", .super_turbo = true },
 138                 { "vddpx", 1800000, 1800000, 0 },
 139         },
 140         .num_pd_vregs = 2,
 141         .num_vregs = 1,
 142 };
 143
 144 static const struct wcnss_data pronto_v3_data = {
 145         .pmu_offset = 0x1004,
 146         .spare_offset = 0x1088,
 147
 148         .pd_names = { "mx", "cx" },
 149         .vregs = (struct wcnss_vreg_info[]) {
 150                 { "vddpx", 1800000, 1800000, 0 },
 151         },
 152         .num_vregs = 1,
 153 };
 154
 155 static int wcnss_load(struct rproc *rproc, const struct firmware *fw)
 156 {
 157         struct qcom_wcnss *wcnss = (struct qcom_wcnss *)rproc->priv;
 158         int ret;
 159
 160         ret = qcom_mdt_load(wcnss->dev, fw, rproc->firmware, WCNSS_PAS_ID,
 161                             wcnss->mem_region, wcnss->mem_phys,
 162                             wcnss->mem_size, &wcnss->mem_reloc);
 163         if (ret)
 164                 return ret;
 165
 166         qcom_pil_info_store("wcnss", wcnss->mem_phys, wcnss->mem_size);
 167
 168         return 0;
 169 }
 170
 171 static void wcnss_indicate_nv_download(struct qcom_wcnss *wcnss)
 172 {
 173         u32 val;
 174
 175         /* Indicate NV download capability */
 176         val = readl(wcnss->spare_out);
 177         val |= WCNSS_SPARE_NVBIN_DLND;
 178         writel(val, wcnss->spare_out);
 179 }
 180
 181 static void wcnss_configure_iris(struct qcom_wcnss *wcnss)
 182 {
 183         u32 val;
 184
 185         /* Clear PMU cfg register */
 186         writel(0, wcnss->pmu_cfg);
 187
 188         val = WCNSS_PMU_GC_BUS_MUX_SEL_TOP | WCNSS_PMU_IRIS_XO_EN;
 189         writel(val, wcnss->pmu_cfg);
 190
 191         /* Clear XO_MODE */
 192         val &= ~WCNSS_PMU_XO_MODE_MASK;
 193         if (wcnss->use_48mhz_xo)
 194                 val |= WCNSS_PMU_XO_MODE_48 << 1;
 195         else
 196                 val |= WCNSS_PMU_XO_MODE_19p2 << 1;
 197         writel(val, wcnss->pmu_cfg);
 198
 199         /* Reset IRIS */
 200         val |= WCNSS_PMU_IRIS_RESET;
 201         writel(val, wcnss->pmu_cfg);
 202
 203         /* Wait for PMU.iris_reg_reset_sts */
 204         while (readl(wcnss->pmu_cfg) & WCNSS_PMU_IRIS_RESET_STS)
 205                 cpu_relax();
 206
 207         /* Clear IRIS reset */
 208         val &= ~WCNSS_PMU_IRIS_RESET;
 209         writel(val, wcnss->pmu_cfg);
 210
 211         /* Start IRIS XO configuration */
 212         val |= WCNSS_PMU_IRIS_XO_CFG;
 213         writel(val, wcnss->pmu_cfg);
 214
 215         /* Wait for XO configuration to finish */
 216         while (readl(wcnss->pmu_cfg) & WCNSS_PMU_IRIS_XO_CFG_STS)
 217                 cpu_relax();
 218
 219         /* Stop IRIS XO configuration */
 220         val &= ~WCNSS_PMU_GC_BUS_MUX_SEL_TOP;
 221         val &= ~WCNSS_PMU_IRIS_XO_CFG;
 222         writel(val, wcnss->pmu_cfg);
 223
 224         /* Add some delay for XO to settle */
 225         msleep(20);
 226 }
 227
 228 static int wcnss_start(struct rproc *rproc)
 229 {
 230         struct qcom_wcnss *wcnss = (struct qcom_wcnss *)rproc->priv;
 231         int ret, i;
 232
 233         mutex_lock(&wcnss->iris_lock);
 234         if (!wcnss->iris) {
 235                 dev_err(wcnss->dev, "no iris registered\n");
 236                 ret = -EINVAL;
 237                 goto release_iris_lock;
 238         }
 239
 240         for (i = 0; i < wcnss->num_pds; i++) {
 241                 dev_pm_genpd_set_performance_state(wcnss->pds[i], INT_MAX);
 242                 ret = pm_runtime_get_sync(wcnss->pds[i]);
 243                 if (ret < 0) {
 244                         pm_runtime_put_noidle(wcnss->pds[i]);
 245                         goto disable_pds;
 246                 }
 247         }
 248
 249         ret = regulator_bulk_enable(wcnss->num_vregs, wcnss->vregs);
 250         if (ret)
 251                 goto disable_pds;
 252
 253         ret = qcom_iris_enable(wcnss->iris);
 254         if (ret)
 255                 goto disable_regulators;
 256
 257         wcnss_indicate_nv_download(wcnss);
 258         wcnss_configure_iris(wcnss);
 259
 260         ret = qcom_scm_pas_auth_and_reset(WCNSS_PAS_ID);
 261         if (ret) {
 262                 dev_err(wcnss->dev,
 263                         "failed to authenticate image and release reset\n");
 264                 goto disable_iris;
 265         }
 266
 267         ret = wait_for_completion_timeout(&wcnss->start_done,
 268                                           msecs_to_jiffies(5000));
 269         if (wcnss->ready_irq > 0 && ret == 0) {
 270                 /* We have a ready_irq, but it didn't fire in time. */
 271                 dev_err(wcnss->dev, "start timed out\n");
 272                 qcom_scm_pas_shutdown(WCNSS_PAS_ID);
 273                 ret = -ETIMEDOUT;
 274                 goto disable_iris;
 275         }
 276
 277         ret = 0;
 278
 279 disable_iris:
 280         qcom_iris_disable(wcnss->iris);
 281 disable_regulators:
 282         regulator_bulk_disable(wcnss->num_vregs, wcnss->vregs);
 283 disable_pds:
 284         for (i--; i >= 0; i--) {
 285                 pm_runtime_put(wcnss->pds[i]);
 286                 dev_pm_genpd_set_performance_state(wcnss->pds[i], 0);
 287         }
 288 release_iris_lock:
 289         mutex_unlock(&wcnss->iris_lock);
 290
 291         return ret;
 292 }
 293
 294 static int wcnss_stop(struct rproc *rproc)
 295 {
 296         struct qcom_wcnss *wcnss = (struct qcom_wcnss *)rproc->priv;
 297         int ret;
 298
 299         if (wcnss->state) {
 300                 qcom_smem_state_update_bits(wcnss->state,
 301                                             BIT(wcnss->stop_bit),
 302                                             BIT(wcnss->stop_bit));
 303
 304                 ret = wait_for_completion_timeout(&wcnss->stop_done,
 305                                                   msecs_to_jiffies(5000));
 306                 if (ret == 0)
 307                         dev_err(wcnss->dev, "timed out on wait\n");
 308
 309                 qcom_smem_state_update_bits(wcnss->state,
 310                                             BIT(wcnss->stop_bit),
 311                                             0);
 312         }
 313
 314         ret = qcom_scm_pas_shutdown(WCNSS_PAS_ID);
 315         if (ret)
 316                 dev_err(wcnss->dev, "failed to shutdown: %d\n", ret);
 317
 318         return ret;
 319 }
 320
 321 static void *wcnss_da_to_va(struct rproc *rproc, u64 da, size_t len, bool *is_iomem)
 322 {
 323         struct qcom_wcnss *wcnss = (struct qcom_wcnss *)rproc->priv;
 324         int offset;
 325
 326         offset = da - wcnss->mem_reloc;
 327         if (offset < 0 || offset + len > wcnss->mem_size)
 328                 return NULL;
 329
 330         return wcnss->mem_region + offset;
 331 }
 332
 333 static const struct rproc_ops wcnss_ops = {
 334         .start = wcnss_start,
 335         .stop = wcnss_stop,
 336         .da_to_va = wcnss_da_to_va,
 337         .parse_fw = qcom_register_dump_segments,
 338         .load = wcnss_load,
 339 };
 340
 341 static irqreturn_t wcnss_wdog_interrupt(int irq, void *dev)
 342 {
 343         struct qcom_wcnss *wcnss = dev;
 344
 345         rproc_report_crash(wcnss->rproc, RPROC_WATCHDOG);
 346
 347         return IRQ_HANDLED;
 348 }
 349
 350 static irqreturn_t wcnss_fatal_interrupt(int irq, void *dev)
 351 {
 352         struct qcom_wcnss *wcnss = dev;
 353         size_t len;
 354         char *msg;
 355
 356         msg = qcom_smem_get(QCOM_SMEM_HOST_ANY, WCNSS_CRASH_REASON_SMEM, &len);
 357         if (!IS_ERR(msg) && len > 0 && msg[0])
 358                 dev_err(wcnss->dev, "fatal error received: %s\n", msg);
 359
 360         rproc_report_crash(wcnss->rproc, RPROC_FATAL_ERROR);
 361
 362         return IRQ_HANDLED;
 363 }
 364
 365 static irqreturn_t wcnss_ready_interrupt(int irq, void *dev)
 366 {
 367         struct qcom_wcnss *wcnss = dev;
 368
 369         complete(&wcnss->start_done);
 370
 371         return IRQ_HANDLED;
 372 }
 373
 374 static irqreturn_t wcnss_handover_interrupt(int irq, void *dev)
 375 {
 376         /*
 377          * XXX: At this point we're supposed to release the resources that we
 378          * have been holding on behalf of the WCNSS. Unfortunately this
 379          * interrupt comes way before the other side seems to be done.
 380          *
 381          * So we're currently relying on the ready interrupt firing later then
 382          * this and we just disable the resources at the end of wcnss_start().
 383          */
 384
 385         return IRQ_HANDLED;
 386 }
 387
 388 static irqreturn_t wcnss_stop_ack_interrupt(int irq, void *dev)
 389 {
 390         struct qcom_wcnss *wcnss = dev;
 391
 392         complete(&wcnss->stop_done);
 393
 394         return IRQ_HANDLED;
 395 }
 396
 397 static int wcnss_init_pds(struct qcom_wcnss *wcnss,
 398                           const char * const pd_names[WCNSS_MAX_PDS])
 399 {
 400         int i, ret;
 401
 402         for (i = 0; i < WCNSS_MAX_PDS; i++) {
 403                 if (!pd_names[i])
 404                         break;
 405
 406                 wcnss->pds[i] = dev_pm_domain_attach_by_name(wcnss->dev, pd_names[i]);
 407                 if (IS_ERR_OR_NULL(wcnss->pds[i])) {
 408                         ret = PTR_ERR(wcnss->pds[i]) ? : -ENODATA;
 409                         for (i--; i >= 0; i--)
 410                                 dev_pm_domain_detach(wcnss->pds[i], false);
 411                         return ret;
 412                 }
 413         }
 414         wcnss->num_pds = i;
 415
 416         return 0;
 417 }
 418
 419 static void wcnss_release_pds(struct qcom_wcnss *wcnss)
 420 {
 421         int i;
 422
 423         for (i = 0; i < wcnss->num_pds; i++)
 424                 dev_pm_domain_detach(wcnss->pds[i], false);
 425 }
 426
 427 static int wcnss_init_regulators(struct qcom_wcnss *wcnss,
 428                                  const struct wcnss_vreg_info *info,
 429                                  int num_vregs, int num_pd_vregs)
 430 {
 431         struct regulator_bulk_data *bulk;
 432         int ret;
 433         int i;
 434
 435         /*
 436          * If attaching the power domains suceeded we can skip requesting
 437          * the regulators for the power domains. For old device trees we need to
 438          * reserve extra space to manage them through the regulator interface.
 439          */
 440         if (wcnss->num_pds)
 441                 info += num_pd_vregs;
 442         else
 443                 num_vregs += num_pd_vregs;
 444
 445         bulk = devm_kcalloc(wcnss->dev,
 446                             num_vregs, sizeof(struct regulator_bulk_data),
 447                             GFP_KERNEL);
 448         if (!bulk)
 449                 return -ENOMEM;
 450
 451         for (i = 0; i < num_vregs; i++)
 452                 bulk[i].supply = info[i].name;
 453
 454         ret = devm_regulator_bulk_get(wcnss->dev, num_vregs, bulk);
 455         if (ret)
 456                 return ret;
 457
 458         for (i = 0; i < num_vregs; i++) {
 459                 if (info[i].max_voltage)
 460                         regulator_set_voltage(bulk[i].consumer,
 461                                               info[i].min_voltage,
 462                                               info[i].max_voltage);
 463
 464                 if (info[i].load_uA)
 465                         regulator_set_load(bulk[i].consumer, info[i].load_uA);
 466         }
 467
 468         wcnss->vregs = bulk;
 469         wcnss->num_vregs = num_vregs;
 470
 471         return 0;
 472 }
 473
 474 static int wcnss_request_irq(struct qcom_wcnss *wcnss,
 475                              struct platform_device *pdev,
 476                              const char *name,
 477                              bool optional,
 478                              irq_handler_t thread_fn)
 479 {
 480         int ret;
 481         int irq_number;
 482
 483         ret = platform_get_irq_byname(pdev, name);
 484         if (ret < 0 && optional) {
 485                 dev_dbg(&pdev->dev, "no %s IRQ defined, ignoring\n", name);
 486                 return 0;
 487         } else if (ret < 0) {
 488                 dev_err(&pdev->dev, "no %s IRQ defined\n", name);
 489                 return ret;
 490         }
 491
 492         irq_number = ret;
 493
 494         ret = devm_request_threaded_irq(&pdev->dev, ret,
 495                                         NULL, thread_fn,
 496                                         IRQF_TRIGGER_RISING | IRQF_ONESHOT,
 497                                         "wcnss", wcnss);
 498         if (ret) {
 499                 dev_err(&pdev->dev, "request %s IRQ failed\n", name);
 500                 return ret;
 501         }
 502
 503         /* Return the IRQ number if the IRQ was successfully acquired */
 504         return irq_number;
 505 }
 506
 507 static int wcnss_alloc_memory_region(struct qcom_wcnss *wcnss)
 508 {
 509         struct device_node *node;
 510         struct resource r;
 511         int ret;
 512
 513         node = of_parse_phandle(wcnss->dev->of_node, "memory-region", 0);
 514         if (!node) {
 515                 dev_err(wcnss->dev, "no memory-region specified\n");
 516                 return -EINVAL;
 517         }
 518
 519         ret = of_address_to_resource(node, 0, &r);
 520         of_node_put(node);
 521         if (ret)
 522                 return ret;
 523
 524         wcnss->mem_phys = wcnss->mem_reloc = r.start;
 525         wcnss->mem_size = resource_size(&r);
 526         wcnss->mem_region = devm_ioremap_wc(wcnss->dev, wcnss->mem_phys, wcnss->mem_size);
 527         if (!wcnss->mem_region) {
 528                 dev_err(wcnss->dev, "unable to map memory region: %pa+%zx\n",
 529                         &r.start, wcnss->mem_size);
 530                 return -EBUSY;
 531         }
 532
 533         return 0;
 534 }
 535
 536 static int wcnss_probe(struct platform_device *pdev)
 537 {
 538         const char *fw_name = WCNSS_FIRMWARE_NAME;
 539         const struct wcnss_data *data;
 540         struct qcom_wcnss *wcnss;
 541         struct resource *res;
 542         struct rproc *rproc;
 543         void __iomem *mmio;
 544         int ret;
 545
 546         data = of_device_get_match_data(&pdev->dev);
 547
 548         if (!qcom_scm_is_available())
 549                 return -EPROBE_DEFER;
 550
 551         if (!qcom_scm_pas_supported(WCNSS_PAS_ID)) {
 552                 dev_err(&pdev->dev, "PAS is not available for WCNSS\n");
 553                 return -ENXIO;
 554         }
 555
 556         ret = of_property_read_string(pdev->dev.of_node, "firmware-name",
 557                                       &fw_name);
 558         if (ret < 0 && ret != -EINVAL)
 559                 return ret;
 560
 561         rproc = rproc_alloc(&pdev->dev, pdev->name, &wcnss_ops,
 562                             fw_name, sizeof(*wcnss));
 563         if (!rproc) {
 564                 dev_err(&pdev->dev, "unable to allocate remoteproc\n");
 565                 return -ENOMEM;
 566         }
 567         rproc_coredump_set_elf_info(rproc, ELFCLASS32, EM_NONE);
 568
 569         wcnss = (struct qcom_wcnss *)rproc->priv;
 570         wcnss->dev = &pdev->dev;
 571         wcnss->rproc = rproc;
 572         platform_set_drvdata(pdev, wcnss);
 573
 574         init_completion(&wcnss->start_done);
 575         init_completion(&wcnss->stop_done);
 576
 577         mutex_init(&wcnss->iris_lock);
 578
 579         res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pmu");
 580         mmio = devm_ioremap_resource(&pdev->dev, res);
 581         if (IS_ERR(mmio)) {
 582                 ret = PTR_ERR(mmio);
 583                 goto free_rproc;
 584         }
 585
 586         ret = wcnss_alloc_memory_region(wcnss);
 587         if (ret)
 588                 goto free_rproc;
 589
 590         wcnss->pmu_cfg = mmio + data->pmu_offset;
 591         wcnss->spare_out = mmio + data->spare_offset;
 592
 593         /*
 594          * We might need to fallback to regulators instead of power domains
 595          * for old device trees. Don't report an error in that case.
 596          */
 597         ret = wcnss_init_pds(wcnss, data->pd_names);
 598         if (ret && (ret != -ENODATA || !data->num_pd_vregs))
 599                 goto free_rproc;
 600
 601         ret = wcnss_init_regulators(wcnss, data->vregs, data->num_vregs,
 602                                     data->num_pd_vregs);
 603         if (ret)
 604                 goto detach_pds;
 605
 606         ret = wcnss_request_irq(wcnss, pdev, "wdog", false, wcnss_wdog_interrupt);
 607         if (ret < 0)
 608                 goto detach_pds;
 609         wcnss->wdog_irq = ret;
 610
 611         ret = wcnss_request_irq(wcnss, pdev, "fatal", false, wcnss_fatal_interrupt);
 612         if (ret < 0)
 613                 goto detach_pds;
 614         wcnss->fatal_irq = ret;
 615
 616         ret = wcnss_request_irq(wcnss, pdev, "ready", true, wcnss_ready_interrupt);
 617         if (ret < 0)
 618                 goto detach_pds;
 619         wcnss->ready_irq = ret;
 620
 621         ret = wcnss_request_irq(wcnss, pdev, "handover", true, wcnss_handover_interrupt);
 622         if (ret < 0)
 623                 goto detach_pds;
 624         wcnss->handover_irq = ret;
 625
 626         ret = wcnss_request_irq(wcnss, pdev, "stop-ack", true, wcnss_stop_ack_interrupt);
 627         if (ret < 0)
 628                 goto detach_pds;
 629         wcnss->stop_ack_irq = ret;
 630
 631         if (wcnss->stop_ack_irq) {
 632                 wcnss->state = devm_qcom_smem_state_get(&pdev->dev, "stop",
 633                                                         &wcnss->stop_bit);
 634                 if (IS_ERR(wcnss->state)) {
 635                         ret = PTR_ERR(wcnss->state);
 636                         goto detach_pds;
 637                 }
 638         }
 639
 640         qcom_add_smd_subdev(rproc, &wcnss->smd_subdev);
 641         wcnss->sysmon = qcom_add_sysmon_subdev(rproc, "wcnss", WCNSS_SSCTL_ID);
 642         if (IS_ERR(wcnss->sysmon)) {
 643                 ret = PTR_ERR(wcnss->sysmon);
 644                 goto detach_pds;
 645         }
 646
 647         wcnss->iris = qcom_iris_probe(&pdev->dev, &wcnss->use_48mhz_xo);
 648         if (IS_ERR(wcnss->iris)) {
 649                 ret = PTR_ERR(wcnss->iris);
 650                 goto detach_pds;
 651         }
 652
 653         ret = rproc_add(rproc);
 654         if (ret)
 655                 goto remove_iris;
 656
 657         return 0;
 658
 659 remove_iris:
 660         qcom_iris_remove(wcnss->iris);
 661 detach_pds:
 662         wcnss_release_pds(wcnss);
 663 free_rproc:
 664         rproc_free(rproc);
 665
 666         return ret;
 667 }
 668
 669 static int wcnss_remove(struct platform_device *pdev)
 670 {
 671         struct qcom_wcnss *wcnss = platform_get_drvdata(pdev);
 672
 673         qcom_iris_remove(wcnss->iris);
 674
 675         rproc_del(wcnss->rproc);
 676
 677         qcom_remove_sysmon_subdev(wcnss->sysmon);
 678         qcom_remove_smd_subdev(wcnss->rproc, &wcnss->smd_subdev);
 679         wcnss_release_pds(wcnss);
 680         rproc_free(wcnss->rproc);
 681
 682         return 0;
 683 }
 684
 685 static const struct of_device_id wcnss_of_match[] = {
 686         { .compatible = "qcom,riva-pil", &riva_data },
 687         { .compatible = "qcom,pronto-v1-pil", &pronto_v1_data },
 688         { .compatible = "qcom,pronto-v2-pil", &pronto_v2_data },
 689         { .compatible = "qcom,pronto-v3-pil", &pronto_v3_data },
 690         { },
 691 };
 692 MODULE_DEVICE_TABLE(of, wcnss_of_match);
 693
 694 static struct platform_driver wcnss_driver = {
 695         .probe = wcnss_probe,
 696         .remove = wcnss_remove,
 697         .driver = {
 698                 .name = "qcom-wcnss-pil",
 699                 .of_match_table = wcnss_of_match,
 700         },
 701 };
 702
 703 module_platform_driver(wcnss_driver);
 704
 705 MODULE_DESCRIPTION("Qualcomm Peripheral Image Loader for Wireless Subsystem");
 706 MODULE_LICENSE("GPL v2");