2 * Legacy iSeries specific vio initialisation
3 * that needs to be built in (not a module).
5 * © Copyright 2007 IBM Corporation
6 * Author: Stephen Rothwell
7 * Some parts collected from various other files
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License as
11 * published by the Free Software Foundation; either version 2 of the
12 * License, or (at your option) any later version.
14 * This program is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 * General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software Foundation,
21 * Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
24 #include <linux/init.h>
25 #include <linux/gfp.h>
26 #include <linux/completion.h>
27 #include <linux/proc_fs.h>
29 #include <asm/firmware.h>
30 #include <asm/iseries/vio.h>
31 #include <asm/iseries/iommu.h>
32 #include <asm/iseries/hv_types.h>
33 #include <asm/iseries/hv_lp_event.h>
37 #define FIRST_VSCSI (FIRST_VTY + NUM_VTYS)
39 #define FIRST_VLAN (FIRST_VSCSI + NUM_VSCSIS)
40 #define NUM_VLANS HVMAXARCHITECTEDVIRTUALLANS
41 #define FIRST_VIODASD (FIRST_VLAN + NUM_VLANS)
42 #define NUM_VIODASDS HVMAXARCHITECTEDVIRTUALDISKS
43 #define FIRST_VIOCD (FIRST_VIODASD + NUM_VIODASDS)
44 #define NUM_VIOCDS HVMAXARCHITECTEDVIRTUALCDROMS
45 #define FIRST_VIOTAPE (FIRST_VIOCD + NUM_VIOCDS)
46 #define NUM_VIOTAPES HVMAXARCHITECTEDVIRTUALTAPES
48 static struct property * __init new_property(const char *name, int length,
51 struct property *np = kzalloc(sizeof(*np) + strlen(name) + 1 + length,
56 np->name = (char *)(np + 1);
57 np->value = np->name + strlen(name) + 1;
58 strcpy(np->name, name);
59 memcpy(np->value, value, length);
64 static void __init free_property(struct property *np)
69 static struct device_node * __init new_node(const char *path,
70 struct device_node *parent)
72 struct device_node *np = kzalloc(sizeof(*np), GFP_KERNEL);
76 np->full_name = kmalloc(strlen(path) + 1, GFP_KERNEL);
81 strcpy(np->full_name, path);
82 of_node_set_flag(np, OF_DYNAMIC);
84 np->parent = of_node_get(parent);
88 static void __init free_node(struct device_node *np)
90 struct property *next;
91 struct property *prop;
93 next = np->properties;
99 of_node_put(np->parent);
100 kfree(np->full_name);
104 static int __init add_string_property(struct device_node *np, const char *name,
107 struct property *nprop = new_property(name, strlen(value) + 1, value);
111 prom_add_property(np, nprop);
115 static int __init add_raw_property(struct device_node *np, const char *name,
116 int length, const void *value)
118 struct property *nprop = new_property(name, length, value);
122 prom_add_property(np, nprop);
126 struct viocd_waitevent {
127 struct completion com;
138 static void __init handle_cd_event(struct HvLpEvent *event)
140 struct viocdlpevent *bevent;
141 struct viocd_waitevent *pwe;
144 /* Notification that a partition went away! */
147 /* First, we should NEVER get an int here...only acks */
148 if (hvlpevent_is_int(event)) {
149 printk(KERN_WARNING "handle_cd_event: got an unexpected int\n");
150 if (hvlpevent_need_ack(event)) {
151 event->xRc = HvLpEvent_Rc_InvalidSubtype;
152 HvCallEvent_ackLpEvent(event);
157 bevent = (struct viocdlpevent *)event;
159 switch (event->xSubtype & VIOMINOR_SUBTYPE_MASK) {
161 pwe = (struct viocd_waitevent *)event->xCorrelationToken;
162 pwe->rc = event->xRc;
163 pwe->sub_result = bevent->sub_result;
168 printk(KERN_WARNING "handle_cd_event: "
169 "message with unexpected subtype %0x04X!\n",
170 event->xSubtype & VIOMINOR_SUBTYPE_MASK);
171 if (hvlpevent_need_ack(event)) {
172 event->xRc = HvLpEvent_Rc_InvalidSubtype;
173 HvCallEvent_ackLpEvent(event);
178 static void __init get_viocd_info(struct device_node *vio_root)
182 struct viocd_waitevent we;
183 struct cdrom_info *unitinfo;
184 dma_addr_t unitinfo_dmaaddr;
187 ret = viopath_open(viopath_hostLp, viomajorsubtype_cdio, 2);
190 "get_viocd_info: error opening path to host partition %d\n",
195 /* Initialize our request handler */
196 vio_setHandler(viomajorsubtype_cdio, handle_cd_event);
198 unitinfo = iseries_hv_alloc(
199 sizeof(*unitinfo) * HVMAXARCHITECTEDVIRTUALCDROMS,
200 &unitinfo_dmaaddr, GFP_ATOMIC);
203 "get_viocd_info: error allocating unitinfo\n");
207 memset(unitinfo, 0, sizeof(*unitinfo) * HVMAXARCHITECTEDVIRTUALCDROMS);
209 init_completion(&we.com);
211 hvrc = HvCallEvent_signalLpEventFast(viopath_hostLp,
212 HvLpEvent_Type_VirtualIo,
213 viomajorsubtype_cdio | viocdgetinfo,
214 HvLpEvent_AckInd_DoAck, HvLpEvent_AckType_ImmediateAck,
215 viopath_sourceinst(viopath_hostLp),
216 viopath_targetinst(viopath_hostLp),
217 (u64)&we, VIOVERSION << 16, unitinfo_dmaaddr, 0,
218 sizeof(*unitinfo) * HVMAXARCHITECTEDVIRTUALCDROMS, 0);
219 if (hvrc != HvLpEvent_Rc_Good) {
221 "get_viocd_info: cdrom error sending event. rc %d\n",
226 wait_for_completion(&we.com);
229 printk(KERN_WARNING "get_viocd_info: bad rc %d:0x%04X\n",
230 we.rc, we.sub_result);
234 for (unit = 0; (unit < HVMAXARCHITECTEDVIRTUALCDROMS) &&
235 unitinfo[unit].rsrcname[0]; unit++) {
236 struct device_node *np;
238 u32 reg = FIRST_VIOCD + unit;
240 snprintf(name, sizeof(name), "/vdevice/viocd@%08x", reg);
241 np = new_node(name, vio_root);
244 if (!add_string_property(np, "name", "viocd") ||
245 !add_string_property(np, "device_type", "block") ||
246 !add_string_property(np, "compatible",
247 "IBM,iSeries-viocd") ||
248 !add_raw_property(np, "reg", sizeof(reg), ®) ||
249 !add_raw_property(np, "linux,unit_address",
250 sizeof(unit), &unit) ||
251 !add_raw_property(np, "linux,vio_rsrcname",
252 sizeof(unitinfo[unit].rsrcname),
253 unitinfo[unit].rsrcname) ||
254 !add_raw_property(np, "linux,vio_type",
255 sizeof(unitinfo[unit].type),
256 unitinfo[unit].type) ||
257 !add_raw_property(np, "linux,vio_model",
258 sizeof(unitinfo[unit].model),
259 unitinfo[unit].model))
261 np->name = of_get_property(np, "name", NULL);
262 np->type = of_get_property(np, "device_type", NULL);
264 #ifdef CONFIG_PROC_DEVICETREE
266 struct proc_dir_entry *ent;
268 ent = proc_mkdir(strrchr(np->full_name, '/') + 1,
271 proc_device_tree_add_node(np, ent);
282 iseries_hv_free(sizeof(*unitinfo) * HVMAXARCHITECTEDVIRTUALCDROMS,
283 unitinfo, unitinfo_dmaaddr);
285 vio_clearHandler(viomajorsubtype_cdio);
286 viopath_close(viopath_hostLp, viomajorsubtype_cdio, 2);
289 static int __init iseries_vio_init(void)
291 struct device_node *vio_root;
293 if (!firmware_has_feature(FW_FEATURE_ISERIES))
298 vio_root = of_find_node_by_path("/vdevice");
302 if (viopath_hostLp == HvLpIndexInvalid) {
304 /* If we don't have a host, bail out */
305 if (viopath_hostLp == HvLpIndexInvalid)
309 get_viocd_info(vio_root);
314 of_node_put(vio_root);
317 arch_initcall(iseries_vio_init);