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