of.c 1.7 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556
  1. /*
  2. * Copyright (c) 2014 Broadcom Corporation
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for any
  5. * purpose with or without fee is hereby granted, provided that the above
  6. * copyright notice and this permission notice appear in all copies.
  7. *
  8. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  9. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
  11. * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
  13. * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
  14. * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. */
  16. #include <linux/init.h>
  17. #include <linux/of.h>
  18. #include <linux/of_irq.h>
  19. #include <linux/mmc/card.h>
  20. #include <linux/platform_data/brcmfmac-sdio.h>
  21. #include <linux/mmc/sdio_func.h>
  22. #include <defs.h>
  23. #include "debug.h"
  24. #include "sdio.h"
  25. void brcmf_of_probe(struct brcmf_sdio_dev *sdiodev)
  26. {
  27. struct device *dev = sdiodev->dev;
  28. struct device_node *np = dev->of_node;
  29. int irq;
  30. u32 irqf;
  31. u32 val;
  32. if (!np || !of_device_is_compatible(np, "brcm,bcm4329-fmac"))
  33. return;
  34. sdiodev->pdata = devm_kzalloc(dev, sizeof(*sdiodev->pdata), GFP_KERNEL);
  35. if (!sdiodev->pdata)
  36. return;
  37. irq = irq_of_parse_and_map(np, 0);
  38. if (!irq) {
  39. brcmf_err("interrupt could not be mapped\n");
  40. devm_kfree(dev, sdiodev->pdata);
  41. return;
  42. }
  43. irqf = irqd_get_trigger_type(irq_get_irq_data(irq));
  44. sdiodev->pdata->oob_irq_supported = true;
  45. sdiodev->pdata->oob_irq_nr = irq;
  46. sdiodev->pdata->oob_irq_flags = irqf;
  47. if (of_property_read_u32(np, "brcm,drive-strength", &val) == 0)
  48. sdiodev->pdata->drive_strength = val;
  49. }