1 // SPDX-License-Identifier: GPL-2.0+ 2 3 /* 4 * Add an IPMI platform device. 5 */ 6 7 #include <linux/platform_device.h> 8 #include "ipmi_plat_data.h" 9 #include "ipmi_si.h" 10 11 struct platform_device *ipmi_platform_add(const char *name, unsigned int inst, 12 struct ipmi_plat_data *p) 13 { 14 struct platform_device *pdev; 15 unsigned int num_r = 1, size = 0, pidx = 0; 16 struct resource r[4]; 17 struct property_entry pr[6]; 18 u32 flags; 19 int rv; 20 21 memset(pr, 0, sizeof(pr)); 22 memset(r, 0, sizeof(r)); 23 24 if (p->iftype == IPMI_PLAT_IF_SI) { 25 if (p->type == SI_BT) 26 size = 3; 27 else if (p->type != SI_TYPE_INVALID) 28 size = 2; 29 30 if (p->regsize == 0) 31 p->regsize = DEFAULT_REGSIZE; 32 if (p->regspacing == 0) 33 p->regspacing = p->regsize; 34 35 pr[pidx++] = PROPERTY_ENTRY_U8("ipmi-type", p->type); 36 } else if (p->iftype == IPMI_PLAT_IF_SSIF) { 37 pr[pidx++] = PROPERTY_ENTRY_U16("i2c-addr", p->addr); 38 } 39 40 if (p->slave_addr) 41 pr[pidx++] = PROPERTY_ENTRY_U8("slave-addr", p->slave_addr); 42 pr[pidx++] = PROPERTY_ENTRY_U8("addr-source", p->addr_source); 43 if (p->regshift) 44 pr[pidx++] = PROPERTY_ENTRY_U8("reg-shift", p->regshift); 45 pr[pidx++] = PROPERTY_ENTRY_U8("reg-size", p->regsize); 46 /* Last entry must be left NULL to terminate it. */ 47 48 pdev = platform_device_alloc(name, inst); 49 if (!pdev) { 50 pr_err("Error allocating IPMI platform device %s.%d\n", 51 name, inst); 52 return NULL; 53 } 54 55 if (size == 0) 56 /* An invalid or SSIF interface, no resources. */ 57 goto add_properties; 58 59 /* 60 * Register spacing is derived from the resources in 61 * the IPMI platform code. 62 */ 63 64 if (p->space == IPMI_IO_ADDR_SPACE) 65 flags = IORESOURCE_IO; 66 else 67 flags = IORESOURCE_MEM; 68 69 r[0].start = p->addr; 70 r[0].end = r[0].start + p->regsize - 1; 71 r[0].name = "IPMI Address 1"; 72 r[0].flags = flags; 73 74 if (size > 1) { 75 r[1].start = r[0].start + p->regspacing; 76 r[1].end = r[1].start + p->regsize - 1; 77 r[1].name = "IPMI Address 2"; 78 r[1].flags = flags; 79 num_r++; 80 } 81 82 if (size > 2) { 83 r[2].start = r[1].start + p->regspacing; 84 r[2].end = r[2].start + p->regsize - 1; 85 r[2].name = "IPMI Address 3"; 86 r[2].flags = flags; 87 num_r++; 88 } 89 90 if (p->irq) { 91 r[num_r].start = p->irq; 92 r[num_r].end = p->irq; 93 r[num_r].name = "IPMI IRQ"; 94 r[num_r].flags = IORESOURCE_IRQ; 95 num_r++; 96 } 97 98 rv = platform_device_add_resources(pdev, r, num_r); 99 if (rv) { 100 dev_err(&pdev->dev, 101 "Unable to add hard-code resources: %d\n", rv); 102 goto err; 103 } 104 add_properties: 105 rv = platform_device_add_properties(pdev, pr); 106 if (rv) { 107 dev_err(&pdev->dev, 108 "Unable to add hard-code properties: %d\n", rv); 109 goto err; 110 } 111 112 rv = platform_device_add(pdev); 113 if (rv) { 114 dev_err(&pdev->dev, 115 "Unable to add hard-code device: %d\n", rv); 116 goto err; 117 } 118 return pdev; 119 120 err: 121 platform_device_put(pdev); 122 return NULL; 123 } 124 EXPORT_SYMBOL(ipmi_platform_add); 125