drivers/mfd/Mfd-core.c

时间:2023-03-09 08:10:36
drivers/mfd/Mfd-core.c

mfd: multifunction device drivers---多功能设备驱动开发;
A product or device that has multiple functions. An example of this might be a printer that also makes copies, faxes, and scans. Another example is a CD or DVD that might contain multiple applications on the same disk; this may be a Mac and PC version of the same software or media meant to be played on more than one platform. Also called multi function product (MFP), all-in-one.

源码主要是做了一些platform_device的注册和添加删除工作。

  1. int mfd_add_devices(struct device *parent, int id,
  2. struct mfd_cell *cells, int n_devs,
  3. struct resource *mem_base,
  4. int irq_base)
  5. {
  6. int i;
  7. int ret = 0;
  8. atomic_t *cnts;
  9. /* initialize reference counting for all cells */
  10. cnts = kcalloc(n_devs, sizeof(*cnts), GFP_KERNEL);
  11. if (!cnts)
  12. return -ENOMEM;
  13. for (i = 0; i < n_devs; i++) {
  14. atomic_set(&cnts[i], 0);
  15. cells[i].usage_count = &cnts[i];
  16. ret = mfd_add_device(parent, id, cells + i, mem_base, irq_base); 调用mfd_add_device()
  17. if (ret)
  18. break;
  19. }
  20. if (ret)
  21. mfd_remove_devices(parent);
  22. return ret;
  23. }
  24. EXPORT_SYMBOL(mfd_add_devices);

在这个函数中,参数cells是数组,个数为参数n_devs。用户调用此函数前初始化了cells部分内容,但其中成员由本函数初始化:

  1. /*
  2. * This struct describes the MFD part ("cell").
  3. * After registration the copy of this structure will become the platform data
  4. * of the resulting platform_device
  5. */
  6. struct mfd_cell {  //个人理解:注册mfd_cell后等效为platform_device
  7. const char      *name;     
  8. int         id;
  9. /* refcounting for multiple drivers to use a single cell */
  10. atomic_t        *usage_count;    //本函数初始化
  11. int         (*enable)(struct platform_device *dev);
  12. int         (*disable)(struct platform_device *dev);
  13. int         (*suspend)(struct platform_device *dev);
  14. int         (*resume)(struct platform_device *dev);
  15. /* platform data passed to the sub devices drivers */
  16. void            *platform_data;
  17. size_t          pdata_size;
  18. /*
  19. * These resources can be specified relative to the parent device.
  20. * For accessing hardware you should use resources from the platform dev
  21. */
  22. int         num_resources;
  23. const struct resource   *resources;
  24. /* don't check for resource conflicts */
  25. bool            ignore_resource_conflicts;
  26. /*
  27. * Disable runtime PM callbacks for this subdevice - see
  28. * pm_runtime_no_callbacks().
  29. */
  30. bool            pm_runtime_no_callbacks;
  31. };

再来看mfd_add_device()

  1. static int mfd_add_device(struct device *parent, int id,
  2. const struct mfd_cell *cell,
  3. struct resource *mem_base,
  4. int irq_base)
  5. {
  6. struct resource *res;
  7. struct platform_device *pdev;
  8. int ret = -ENOMEM;
  9. int r;
  10. pdev = platform_device_alloc(cell->name, id + cell->id); //申请pdev内存并初始化name和id
  11. if (!pdev)
  12. goto fail_alloc;
  13. res = kzalloc(sizeof(*res) * cell->num_resources, GFP_KERNEL);
  14. if (!res)
  15. goto fail_device;
  16. pdev->dev.parent = parent;
  17. pdev->dev.type = &mfd_dev_type;
  18. if (cell->pdata_size) {  //重新分配pdev->dev. platform_data内存并将cell->platform_data赋给它。
  19. ret = platform_device_add_data(pdev,
  20. cell->platform_data, cell->pdata_size);
  21. if (ret)
  22. goto fail_res;
  23. }
  24. ret = mfd_platform_add_cell(pdev, cell); //重新分配pdev->mfd_cell内存并将cell赋给它。
  25. if (ret)
  26. goto fail_res;
  27. //初始化cell->num_resources 个数量的res将它赋给pdev->resource
  28. for (r = 0; r < cell->num_resources; r++) {
  29. res[r].name = cell->resources[r].name;
  30. res[r].flags = cell->resources[r].flags;
  31. /* Find out base to use */
  32. if ((cell->resources[r].flags & IORESOURCE_MEM) && mem_base) {
  33. res[r].parent = mem_base;
  34. res[r].start = mem_base->start +    //cell中的每个内存start都要加上mem_base->start
  35. cell->resources[r].start;
  36. res[r].end = mem_base->start +
  37. cell->resources[r].end;
  38. } else if (cell->resources[r].flags & IORESOURCE_IRQ) {
  39. res[r].start = irq_base +           //每个cell中的irq都要加上irq_base。
  40. cell->resources[r].start;
  41. res[r].end   = irq_base +
  42. cell->resources[r].end;
  43. } else {
  44. res[r].parent = cell->resources[r].parent;
  45. res[r].start = cell->resources[r].start;
  46. res[r].end   = cell->resources[r].end;
  47. }
  48. if (!cell->ignore_resource_conflicts) {
  49. ret = acpi_check_resource_conflict(&res[r]);
  50. if (ret)
  51. goto fail_res;
  52. }
  53. }
  54. ret = platform_device_add_resources(pdev, res, cell->num_resources);//将多个res赋给pdev
  55. if (ret)
  56. goto fail_res;
  57. ret = platform_device_add(pdev); //添加一个platform_device到系统,这时在dev的驱动中会使用这些res数据。
  58. if (ret)
  59. goto fail_res;
  60. if (cell->pm_runtime_no_callbacks)
  61. pm_runtime_no_callbacks(&pdev->dev);
  62. kfree(res);
  63. return 0;
  64. fail_res:
  65. kfree(res);
  66. fail_device:
  67. platform_device_put(pdev);
  68. fail_alloc:
  69. return ret;
  70. }