blob: 69d56c7284d1a8f5c2211b37a548f70ba16eaa0a [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * drivers/s390/cio/css.c
3 * driver for channel subsystem
Linus Torvalds1da177e2005-04-16 15:20:36 -07004 *
5 * Copyright (C) 2002 IBM Deutschland Entwicklung GmbH,
6 * IBM Corporation
7 * Author(s): Arnd Bergmann (arndb@de.ibm.com)
Cornelia Huck4ce3b302006-01-14 13:21:04 -08008 * Cornelia Huck (cornelia.huck@de.ibm.com)
Linus Torvalds1da177e2005-04-16 15:20:36 -07009 */
10#include <linux/module.h>
11#include <linux/init.h>
12#include <linux/device.h>
13#include <linux/slab.h>
14#include <linux/errno.h>
15#include <linux/list.h>
Cornelia Hucka55360d2007-10-12 16:11:20 +020016#include <linux/reboot.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070017
18#include "css.h"
19#include "cio.h"
20#include "cio_debug.h"
21#include "ioasm.h"
22#include "chsc.h"
Peter Oberparleiter40154b82006-06-29 14:57:03 +020023#include "device.h"
Peter Oberparleiter83b33702007-04-27 16:01:34 +020024#include "idset.h"
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +020025#include "chp.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070026
Linus Torvalds1da177e2005-04-16 15:20:36 -070027int css_init_done = 0;
Peter Oberparleiter40154b82006-06-29 14:57:03 +020028static int need_reprobe = 0;
Cornelia Huckfb6958a2006-01-06 00:19:25 -080029static int max_ssid = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070030
Cornelia Huck7c9f4e32007-10-12 16:11:13 +020031struct channel_subsystem *channel_subsystems[__MAX_CSSID + 1];
Linus Torvalds1da177e2005-04-16 15:20:36 -070032
Cornelia Hucka28c6942006-01-06 00:19:23 -080033int css_characteristics_avail = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070034
Heiko Carstens4d284ca2007-02-05 21:18:53 +010035int
Cornelia Huckf97a56f2006-01-06 00:19:22 -080036for_each_subchannel(int(*fn)(struct subchannel_id, void *), void *data)
37{
38 struct subchannel_id schid;
39 int ret;
40
41 init_subchannel_id(&schid);
42 ret = -ENODEV;
43 do {
Cornelia Huckfb6958a2006-01-06 00:19:25 -080044 do {
45 ret = fn(schid, data);
46 if (ret)
47 break;
48 } while (schid.sch_no++ < __MAX_SUBCHANNEL);
49 schid.sch_no = 0;
50 } while (schid.ssid++ < max_ssid);
Cornelia Huckf97a56f2006-01-06 00:19:22 -080051 return ret;
52}
53
Linus Torvalds1da177e2005-04-16 15:20:36 -070054static struct subchannel *
Cornelia Hucka8237fc2006-01-06 00:19:21 -080055css_alloc_subchannel(struct subchannel_id schid)
Linus Torvalds1da177e2005-04-16 15:20:36 -070056{
57 struct subchannel *sch;
58 int ret;
59
60 sch = kmalloc (sizeof (*sch), GFP_KERNEL | GFP_DMA);
61 if (sch == NULL)
62 return ERR_PTR(-ENOMEM);
Cornelia Hucka8237fc2006-01-06 00:19:21 -080063 ret = cio_validate_subchannel (sch, schid);
Linus Torvalds1da177e2005-04-16 15:20:36 -070064 if (ret < 0) {
65 kfree(sch);
66 return ERR_PTR(ret);
67 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070068
69 if (sch->st != SUBCHANNEL_TYPE_IO) {
70 /* For now we ignore all non-io subchannels. */
71 kfree(sch);
72 return ERR_PTR(-EINVAL);
73 }
74
75 /*
76 * Set intparm to subchannel address.
77 * This is fine even on 64bit since the subchannel is always located
78 * under 2G.
79 */
Cornelia Huckcd6b4f22008-01-26 14:10:43 +010080 sch->schib.pmcw.intparm = (u32)(addr_t)sch;
Linus Torvalds1da177e2005-04-16 15:20:36 -070081 ret = cio_modify(sch);
82 if (ret) {
Cornelia Huck5693ce62007-08-10 14:32:26 +020083 kfree(sch->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -070084 kfree(sch);
85 return ERR_PTR(ret);
86 }
87 return sch;
88}
89
90static void
91css_free_subchannel(struct subchannel *sch)
92{
93 if (sch) {
94 /* Reset intparm to zeroes. */
95 sch->schib.pmcw.intparm = 0;
96 cio_modify(sch);
Cornelia Huck2ec22982006-12-08 15:54:26 +010097 kfree(sch->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -070098 kfree(sch);
99 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100}
101
102static void
103css_subchannel_release(struct device *dev)
104{
105 struct subchannel *sch;
106
107 sch = to_subchannel(dev);
Cornelia Huck2ec22982006-12-08 15:54:26 +0100108 if (!cio_is_console(sch->schid)) {
109 kfree(sch->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110 kfree(sch);
Cornelia Huck2ec22982006-12-08 15:54:26 +0100111 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112}
113
Cornelia Huck07c6a332007-07-27 12:29:10 +0200114static int css_sch_device_register(struct subchannel *sch)
Cornelia Huck6ab48792006-07-12 16:39:50 +0200115{
116 int ret;
117
118 mutex_lock(&sch->reg_mutex);
119 ret = device_register(&sch->dev);
120 mutex_unlock(&sch->reg_mutex);
121 return ret;
122}
123
124void css_sch_device_unregister(struct subchannel *sch)
125{
126 mutex_lock(&sch->reg_mutex);
127 device_unregister(&sch->dev);
128 mutex_unlock(&sch->reg_mutex);
129}
130
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +0200131static void ssd_from_pmcw(struct chsc_ssd_info *ssd, struct pmcw *pmcw)
132{
133 int i;
134 int mask;
135
136 memset(ssd, 0, sizeof(struct chsc_ssd_info));
137 ssd->path_mask = pmcw->pim;
138 for (i = 0; i < 8; i++) {
139 mask = 0x80 >> i;
140 if (pmcw->pim & mask) {
141 chp_id_init(&ssd->chpid[i]);
142 ssd->chpid[i].id = pmcw->chpid[i];
143 }
144 }
145}
146
147static void ssd_register_chpids(struct chsc_ssd_info *ssd)
148{
149 int i;
150 int mask;
151
152 for (i = 0; i < 8; i++) {
153 mask = 0x80 >> i;
154 if (ssd->path_mask & mask)
155 if (!chp_is_registered(ssd->chpid[i]))
156 chp_new(ssd->chpid[i]);
157 }
158}
159
160void css_update_ssd_info(struct subchannel *sch)
161{
162 int ret;
163
164 if (cio_is_console(sch->schid)) {
165 /* Console is initialized too early for functions requiring
166 * memory allocation. */
167 ssd_from_pmcw(&sch->ssd_info, &sch->schib.pmcw);
168 } else {
169 ret = chsc_get_ssd_info(sch->schid, &sch->ssd_info);
170 if (ret)
171 ssd_from_pmcw(&sch->ssd_info, &sch->schib.pmcw);
172 ssd_register_chpids(&sch->ssd_info);
173 }
174}
175
176static int css_register_subchannel(struct subchannel *sch)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177{
178 int ret;
179
180 /* Initialize the subchannel structure */
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200181 sch->dev.parent = &channel_subsystems[0]->device;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182 sch->dev.bus = &css_bus_type;
183 sch->dev.release = &css_subchannel_release;
Cornelia Huck529192f2006-12-08 15:55:57 +0100184 sch->dev.groups = subch_attr_groups;
Cornelia Huck5bf04b22007-10-22 12:52:41 +0200185 /*
186 * We don't want to generate uevents for I/O subchannels that don't
187 * have a working ccw device behind them since they will be
188 * unregistered before they can be used anyway, so we delay the add
189 * uevent until after device recognition was successful.
190 */
191 if (!cio_is_console(sch->schid))
192 /* Console is special, no need to suppress. */
193 sch->dev.uevent_suppress = 1;
Peter Oberparleiter7ad6a242007-04-27 16:01:35 +0200194 css_update_ssd_info(sch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700195 /* make it known to the system */
Cornelia Huck6ab48792006-07-12 16:39:50 +0200196 ret = css_sch_device_register(sch);
Cornelia Huck7674da72006-12-08 15:54:21 +0100197 if (ret) {
Cornelia Hucke556bbb2007-07-27 12:29:19 +0200198 CIO_MSG_EVENT(0, "Could not register sch 0.%x.%04x: %d\n",
199 sch->schid.ssid, sch->schid.sch_no, ret);
Cornelia Huck7674da72006-12-08 15:54:21 +0100200 return ret;
201 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700202 return ret;
203}
204
Cornelia Huckf7e5d672007-05-10 15:45:43 +0200205static int css_probe_device(struct subchannel_id schid)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206{
207 int ret;
208 struct subchannel *sch;
209
Cornelia Hucka8237fc2006-01-06 00:19:21 -0800210 sch = css_alloc_subchannel(schid);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211 if (IS_ERR(sch))
212 return PTR_ERR(sch);
213 ret = css_register_subchannel(sch);
214 if (ret)
215 css_free_subchannel(sch);
216 return ret;
217}
218
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700219static int
220check_subchannel(struct device * dev, void * data)
221{
222 struct subchannel *sch;
Cornelia Hucka8237fc2006-01-06 00:19:21 -0800223 struct subchannel_id *schid = data;
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700224
225 sch = to_subchannel(dev);
Cornelia Hucka8237fc2006-01-06 00:19:21 -0800226 return schid_equal(&sch->schid, schid);
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700227}
228
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229struct subchannel *
Cornelia Hucka8237fc2006-01-06 00:19:21 -0800230get_subchannel_by_schid(struct subchannel_id schid)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232 struct device *dev;
233
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700234 dev = bus_find_device(&css_bus_type, NULL,
Cornelia Huck12975ae2006-10-11 15:31:47 +0200235 &schid, check_subchannel);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700236
Cornelia Huckb0744bd2005-06-25 14:55:27 -0700237 return dev ? to_subchannel(dev) : NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700238}
239
Cornelia Huckb279a4f2008-01-26 14:10:45 +0100240/**
241 * css_sch_is_valid() - check if a subchannel is valid
242 * @schib: subchannel information block for the subchannel
243 */
244int css_sch_is_valid(struct schib *schib)
245{
246 if ((schib->pmcw.st == SUBCHANNEL_TYPE_IO) && !schib->pmcw.dnv)
247 return 0;
248 return 1;
249}
250EXPORT_SYMBOL_GPL(css_sch_is_valid);
251
Heiko Carstens4d284ca2007-02-05 21:18:53 +0100252static int css_get_subchannel_status(struct subchannel *sch)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700253{
254 struct schib schib;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255
Cornelia Huckb279a4f2008-01-26 14:10:45 +0100256 if (stsch(sch->schid, &schib))
257 return CIO_GONE;
258 if (!css_sch_is_valid(&schib))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700259 return CIO_GONE;
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200260 if (sch->schib.pmcw.dnv && (schib.pmcw.dev != sch->schib.pmcw.dev))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261 return CIO_REVALIDATE;
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200262 if (!sch->lpm)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700263 return CIO_NO_PATH;
264 return CIO_OPER;
265}
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200266
267static int css_evaluate_known_subchannel(struct subchannel *sch, int slow)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700268{
269 int event, ret, disc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270 unsigned long flags;
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200271 enum { NONE, UNREGISTER, UNREGISTER_PROBE, REPROBE } action;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272
Cornelia Huck2ec22982006-12-08 15:54:26 +0100273 spin_lock_irqsave(sch->lock, flags);
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200274 disc = device_is_disconnected(sch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700275 if (disc && slow) {
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200276 /* Disconnected devices are evaluated directly only.*/
Cornelia Huck2ec22982006-12-08 15:54:26 +0100277 spin_unlock_irqrestore(sch->lock, flags);
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200278 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279 }
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200280 /* No interrupt after machine check - kill pending timers. */
281 device_kill_pending_timer(sch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282 if (!disc && !slow) {
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200283 /* Non-disconnected devices are evaluated on the slow path. */
Cornelia Huck2ec22982006-12-08 15:54:26 +0100284 spin_unlock_irqrestore(sch->lock, flags);
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200285 return -EAGAIN;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700286 }
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200287 event = css_get_subchannel_status(sch);
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800288 CIO_MSG_EVENT(4, "Evaluating schid 0.%x.%04x, event %d, %s, %s path.\n",
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200289 sch->schid.ssid, sch->schid.sch_no, event,
290 disc ? "disconnected" : "normal",
291 slow ? "slow" : "fast");
292 /* Analyze subchannel status. */
293 action = NONE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700294 switch (event) {
295 case CIO_NO_PATH:
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200296 if (disc) {
297 /* Check if paths have become available. */
298 action = REPROBE;
299 break;
300 }
301 /* fall through */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700302 case CIO_GONE:
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200303 /* Prevent unwanted effects when opening lock. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304 cio_disable_subchannel(sch);
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200305 device_set_disconnected(sch);
306 /* Ask driver what to do with device. */
307 action = UNREGISTER;
308 if (sch->driver && sch->driver->notify) {
Cornelia Huck2ec22982006-12-08 15:54:26 +0100309 spin_unlock_irqrestore(sch->lock, flags);
Cornelia Huck602b20f2008-01-26 14:10:39 +0100310 ret = sch->driver->notify(sch, event);
Cornelia Huck2ec22982006-12-08 15:54:26 +0100311 spin_lock_irqsave(sch->lock, flags);
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200312 if (ret)
313 action = NONE;
314 }
315 break;
316 case CIO_REVALIDATE:
317 /* Device will be removed, so no notify necessary. */
318 if (disc)
319 /* Reprobe because immediate unregister might block. */
320 action = REPROBE;
321 else
322 action = UNREGISTER_PROBE;
323 break;
324 case CIO_OPER:
325 if (disc)
326 /* Get device operational again. */
327 action = REPROBE;
328 break;
329 }
330 /* Perform action. */
331 ret = 0;
332 switch (action) {
333 case UNREGISTER:
334 case UNREGISTER_PROBE:
335 /* Unregister device (will use subchannel lock). */
Cornelia Huck2ec22982006-12-08 15:54:26 +0100336 spin_unlock_irqrestore(sch->lock, flags);
Cornelia Huck6ab48792006-07-12 16:39:50 +0200337 css_sch_device_unregister(sch);
Cornelia Huck2ec22982006-12-08 15:54:26 +0100338 spin_lock_irqsave(sch->lock, flags);
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200339
Linus Torvalds1da177e2005-04-16 15:20:36 -0700340 /* Reset intparm to zeroes. */
341 sch->schib.pmcw.intparm = 0;
342 cio_modify(sch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343 break;
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200344 case REPROBE:
345 device_trigger_reprobe(sch);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346 break;
347 default:
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200348 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700349 }
Cornelia Huck2ec22982006-12-08 15:54:26 +0100350 spin_unlock_irqrestore(sch->lock, flags);
Cornelia Huckc2b14492006-10-27 12:39:17 +0200351 /* Probe if necessary. */
352 if (action == UNREGISTER_PROBE)
353 ret = css_probe_device(sch->schid);
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200354
355 return ret;
356}
357
358static int css_evaluate_new_subchannel(struct subchannel_id schid, int slow)
359{
360 struct schib schib;
361
362 if (!slow) {
363 /* Will be done on the slow path. */
364 return -EAGAIN;
365 }
Cornelia Huckb279a4f2008-01-26 14:10:45 +0100366 if (stsch_err(schid, &schib) || !css_sch_is_valid(&schib)) {
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200367 /* Unusable - ignore. */
368 return 0;
369 }
370 CIO_MSG_EVENT(4, "Evaluating schid 0.%x.%04x, event %d, unknown, "
371 "slow path.\n", schid.ssid, schid.sch_no, CIO_OPER);
372
373 return css_probe_device(schid);
374}
375
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200376static void css_evaluate_subchannel(struct subchannel_id schid, int slow)
Peter Oberparleiter564337f2006-09-20 16:00:01 +0200377{
378 struct subchannel *sch;
379 int ret;
380
381 sch = get_subchannel_by_schid(schid);
382 if (sch) {
383 ret = css_evaluate_known_subchannel(sch, slow);
384 put_device(&sch->dev);
385 } else
386 ret = css_evaluate_new_subchannel(schid, slow);
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200387 if (ret == -EAGAIN)
388 css_schedule_eval(schid);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389}
390
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200391static struct idset *slow_subchannel_set;
392static spinlock_t slow_subchannel_lock;
393
394static int __init slow_subchannel_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395{
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200396 spin_lock_init(&slow_subchannel_lock);
397 slow_subchannel_set = idset_sch_new();
398 if (!slow_subchannel_set) {
Cornelia Hucke556bbb2007-07-27 12:29:19 +0200399 CIO_MSG_EVENT(0, "could not allocate slow subchannel set\n");
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200400 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401 }
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200402 return 0;
403}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200405static void css_slow_path_func(struct work_struct *unused)
406{
407 struct subchannel_id schid;
408
409 CIO_TRACE_EVENT(4, "slowpath");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410 spin_lock_irq(&slow_subchannel_lock);
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200411 init_subchannel_id(&schid);
412 while (idset_sch_get_first(slow_subchannel_set, &schid)) {
413 idset_sch_del(slow_subchannel_set, schid);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700414 spin_unlock_irq(&slow_subchannel_lock);
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200415 css_evaluate_subchannel(schid, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416 spin_lock_irq(&slow_subchannel_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417 }
418 spin_unlock_irq(&slow_subchannel_lock);
419}
420
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200421static DECLARE_WORK(slow_path_work, css_slow_path_func);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422struct workqueue_struct *slow_path_wq;
423
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200424void css_schedule_eval(struct subchannel_id schid)
425{
426 unsigned long flags;
427
428 spin_lock_irqsave(&slow_subchannel_lock, flags);
429 idset_sch_add(slow_subchannel_set, schid);
430 queue_work(slow_path_wq, &slow_path_work);
431 spin_unlock_irqrestore(&slow_subchannel_lock, flags);
432}
433
434void css_schedule_eval_all(void)
435{
436 unsigned long flags;
437
438 spin_lock_irqsave(&slow_subchannel_lock, flags);
439 idset_fill(slow_subchannel_set);
440 queue_work(slow_path_wq, &slow_path_work);
441 spin_unlock_irqrestore(&slow_subchannel_lock, flags);
442}
443
Peter Oberparleiter40154b82006-06-29 14:57:03 +0200444/* Reprobe subchannel if unregistered. */
445static int reprobe_subchannel(struct subchannel_id schid, void *data)
446{
447 struct subchannel *sch;
448 int ret;
449
Cornelia Hucke556bbb2007-07-27 12:29:19 +0200450 CIO_MSG_EVENT(6, "cio: reprobe 0.%x.%04x\n",
451 schid.ssid, schid.sch_no);
Peter Oberparleiter40154b82006-06-29 14:57:03 +0200452 if (need_reprobe)
453 return -EAGAIN;
454
455 sch = get_subchannel_by_schid(schid);
456 if (sch) {
457 /* Already known. */
458 put_device(&sch->dev);
459 return 0;
460 }
461
462 ret = css_probe_device(schid);
463 switch (ret) {
464 case 0:
465 break;
466 case -ENXIO:
467 case -ENOMEM:
Peter Oberparleiter671756162007-12-04 16:09:02 +0100468 case -EIO:
Peter Oberparleiter40154b82006-06-29 14:57:03 +0200469 /* These should abort looping */
470 break;
471 default:
472 ret = 0;
473 }
474
475 return ret;
476}
477
478/* Work function used to reprobe all unregistered subchannels. */
Al Viro4927b3f2006-12-06 19:18:20 +0000479static void reprobe_all(struct work_struct *unused)
Peter Oberparleiter40154b82006-06-29 14:57:03 +0200480{
481 int ret;
482
483 CIO_MSG_EVENT(2, "reprobe start\n");
484
485 need_reprobe = 0;
486 /* Make sure initial subchannel scan is done. */
487 wait_event(ccw_device_init_wq,
488 atomic_read(&ccw_device_init_count) == 0);
489 ret = for_each_subchannel(reprobe_subchannel, NULL);
490
491 CIO_MSG_EVENT(2, "reprobe done (rc=%d, need_reprobe=%d)\n", ret,
492 need_reprobe);
493}
494
Heiko Carstens2b67fc42007-02-05 21:16:47 +0100495static DECLARE_WORK(css_reprobe_work, reprobe_all);
Peter Oberparleiter40154b82006-06-29 14:57:03 +0200496
497/* Schedule reprobing of all unregistered subchannels. */
498void css_schedule_reprobe(void)
499{
500 need_reprobe = 1;
Cornelia Huckc5d4a992007-11-20 11:13:41 +0100501 queue_work(slow_path_wq, &css_reprobe_work);
Peter Oberparleiter40154b82006-06-29 14:57:03 +0200502}
503
504EXPORT_SYMBOL_GPL(css_schedule_reprobe);
505
Linus Torvalds1da177e2005-04-16 15:20:36 -0700506/*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 * Called from the machine check handler for subchannel report words.
508 */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200509void css_process_crw(int rsid1, int rsid2)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510{
Cornelia Hucka8237fc2006-01-06 00:19:21 -0800511 struct subchannel_id mchk_schid;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800513 CIO_CRW_EVENT(2, "source is subchannel %04X, subsystem id %x\n",
514 rsid1, rsid2);
Cornelia Hucka8237fc2006-01-06 00:19:21 -0800515 init_subchannel_id(&mchk_schid);
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800516 mchk_schid.sch_no = rsid1;
517 if (rsid2 != 0)
518 mchk_schid.ssid = (rsid2 >> 8) & 3;
519
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520 /*
521 * Since we are always presented with IPI in the CRW, we have to
522 * use stsch() to find out if the subchannel in question has come
523 * or gone.
524 */
Peter Oberparleiter83b33702007-04-27 16:01:34 +0200525 css_evaluate_subchannel(mchk_schid, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526}
527
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800528static int __init
529__init_channel_subsystem(struct subchannel_id schid, void *data)
530{
531 struct subchannel *sch;
532 int ret;
533
534 if (cio_is_console(schid))
535 sch = cio_get_console_subchannel();
536 else {
537 sch = css_alloc_subchannel(schid);
538 if (IS_ERR(sch))
539 ret = PTR_ERR(sch);
540 else
541 ret = 0;
542 switch (ret) {
543 case 0:
544 break;
545 case -ENOMEM:
546 panic("Out of memory in init_channel_subsystem\n");
547 /* -ENXIO: no more subchannels. */
548 case -ENXIO:
549 return ret;
Greg Smithe843e282006-03-14 19:50:17 -0800550 /* -EIO: this subchannel set not supported. */
551 case -EIO:
552 return ret;
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800553 default:
554 return 0;
555 }
556 }
557 /*
558 * We register ALL valid subchannels in ioinfo, even those
559 * that have been present before init_channel_subsystem.
560 * These subchannels can't have been registered yet (kmalloc
561 * not working) so we do it now. This is true e.g. for the
562 * console subchannel.
563 */
564 css_register_subchannel(sch);
565 return 0;
566}
567
Linus Torvalds1da177e2005-04-16 15:20:36 -0700568static void __init
Cornelia Hucka28c6942006-01-06 00:19:23 -0800569css_generate_pgid(struct channel_subsystem *css, u32 tod_high)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700570{
Cornelia Hucka28c6942006-01-06 00:19:23 -0800571 if (css_characteristics_avail && css_general_characteristics.mcss) {
572 css->global_pgid.pgid_high.ext_cssid.version = 0x80;
573 css->global_pgid.pgid_high.ext_cssid.cssid = css->cssid;
574 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575#ifdef CONFIG_SMP
Cornelia Hucka28c6942006-01-06 00:19:23 -0800576 css->global_pgid.pgid_high.cpu_addr = hard_smp_processor_id();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700577#else
Cornelia Hucka28c6942006-01-06 00:19:23 -0800578 css->global_pgid.pgid_high.cpu_addr = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700579#endif
580 }
Cornelia Hucka28c6942006-01-06 00:19:23 -0800581 css->global_pgid.cpu_id = ((cpuid_t *) __LC_CPUID)->ident;
582 css->global_pgid.cpu_model = ((cpuid_t *) __LC_CPUID)->machine;
583 css->global_pgid.tod_high = tod_high;
584
585}
586
Cornelia Huck3b793062006-01-06 00:19:26 -0800587static void
588channel_subsystem_release(struct device *dev)
589{
590 struct channel_subsystem *css;
591
592 css = to_css(dev);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800593 mutex_destroy(&css->mutex);
Cornelia Huck3b793062006-01-06 00:19:26 -0800594 kfree(css);
595}
596
Cornelia Huck495a5b42006-03-24 03:15:14 -0800597static ssize_t
598css_cm_enable_show(struct device *dev, struct device_attribute *attr,
599 char *buf)
600{
601 struct channel_subsystem *css = to_css(dev);
602
603 if (!css)
604 return 0;
605 return sprintf(buf, "%x\n", css->cm_enabled);
606}
607
608static ssize_t
609css_cm_enable_store(struct device *dev, struct device_attribute *attr,
610 const char *buf, size_t count)
611{
612 struct channel_subsystem *css = to_css(dev);
613 int ret;
614
615 switch (buf[0]) {
616 case '0':
617 ret = css->cm_enabled ? chsc_secm(css, 0) : 0;
618 break;
619 case '1':
620 ret = css->cm_enabled ? 0 : chsc_secm(css, 1);
621 break;
622 default:
623 ret = -EINVAL;
624 }
625 return ret < 0 ? ret : count;
626}
627
628static DEVICE_ATTR(cm_enable, 0644, css_cm_enable_show, css_cm_enable_store);
629
Heiko Carstens4d284ca2007-02-05 21:18:53 +0100630static int __init setup_css(int nr)
Cornelia Hucka28c6942006-01-06 00:19:23 -0800631{
632 u32 tod_high;
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100633 int ret;
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200634 struct channel_subsystem *css;
Cornelia Hucka28c6942006-01-06 00:19:23 -0800635
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200636 css = channel_subsystems[nr];
637 memset(css, 0, sizeof(struct channel_subsystem));
638 css->pseudo_subchannel =
639 kzalloc(sizeof(*css->pseudo_subchannel), GFP_KERNEL);
640 if (!css->pseudo_subchannel)
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100641 return -ENOMEM;
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200642 css->pseudo_subchannel->dev.parent = &css->device;
643 css->pseudo_subchannel->dev.release = css_subchannel_release;
644 sprintf(css->pseudo_subchannel->dev.bus_id, "defunct");
645 ret = cio_create_sch_lock(css->pseudo_subchannel);
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100646 if (ret) {
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200647 kfree(css->pseudo_subchannel);
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100648 return ret;
649 }
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200650 mutex_init(&css->mutex);
651 css->valid = 1;
652 css->cssid = nr;
653 sprintf(css->device.bus_id, "css%x", nr);
654 css->device.release = channel_subsystem_release;
Cornelia Hucka28c6942006-01-06 00:19:23 -0800655 tod_high = (u32) (get_clock() >> 32);
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200656 css_generate_pgid(css, tod_high);
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100657 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700658}
659
Cornelia Hucka55360d2007-10-12 16:11:20 +0200660static int css_reboot_event(struct notifier_block *this,
661 unsigned long event,
662 void *ptr)
663{
664 int ret, i;
665
666 ret = NOTIFY_DONE;
667 for (i = 0; i <= __MAX_CSSID; i++) {
668 struct channel_subsystem *css;
669
670 css = channel_subsystems[i];
671 if (css->cm_enabled)
672 if (chsc_secm(css, 0))
673 ret = NOTIFY_BAD;
674 }
675
676 return ret;
677}
678
679static struct notifier_block css_reboot_notifier = {
680 .notifier_call = css_reboot_event,
681};
682
Linus Torvalds1da177e2005-04-16 15:20:36 -0700683/*
684 * Now that the driver core is running, we can setup our channel subsystem.
685 * The struct subchannel's are created during probing (except for the
686 * static console subchannel).
687 */
688static int __init
689init_channel_subsystem (void)
690{
Cornelia Hucka28c6942006-01-06 00:19:23 -0800691 int ret, i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700692
Cornelia Huck4434a382007-07-27 12:29:21 +0200693 ret = chsc_determine_css_characteristics();
694 if (ret == -ENOMEM)
695 goto out; /* No need to continue. */
696 if (ret == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700697 css_characteristics_avail = 1;
698
Cornelia Huck4434a382007-07-27 12:29:21 +0200699 ret = chsc_alloc_sei_area();
700 if (ret)
701 goto out;
702
703 ret = slow_subchannel_init();
704 if (ret)
705 goto out;
706
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707 if ((ret = bus_register(&css_bus_type)))
708 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700709
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800710 /* Try to enable MSS. */
711 ret = chsc_enable_facility(CHSC_SDA_OC_MSS);
712 switch (ret) {
713 case 0: /* Success. */
714 max_ssid = __MAX_SSID;
715 break;
716 case -ENOMEM:
717 goto out_bus;
718 default:
719 max_ssid = 0;
720 }
Cornelia Hucka28c6942006-01-06 00:19:23 -0800721 /* Setup css structure. */
722 for (i = 0; i <= __MAX_CSSID; i++) {
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200723 struct channel_subsystem *css;
724
725 css = kmalloc(sizeof(struct channel_subsystem), GFP_KERNEL);
726 if (!css) {
Cornelia Hucka28c6942006-01-06 00:19:23 -0800727 ret = -ENOMEM;
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800728 goto out_unregister;
Cornelia Hucka28c6942006-01-06 00:19:23 -0800729 }
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200730 channel_subsystems[i] = css;
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100731 ret = setup_css(i);
Cornelia Hucka28c6942006-01-06 00:19:23 -0800732 if (ret)
733 goto out_free;
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200734 ret = device_register(&css->device);
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100735 if (ret)
736 goto out_free_all;
Cornelia Huck7e560812006-07-12 16:40:19 +0200737 if (css_characteristics_avail &&
738 css_chsc_characteristics.secm) {
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200739 ret = device_create_file(&css->device,
Cornelia Huck7e560812006-07-12 16:40:19 +0200740 &dev_attr_cm_enable);
741 if (ret)
742 goto out_device;
743 }
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200744 ret = device_register(&css->pseudo_subchannel->dev);
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100745 if (ret)
746 goto out_file;
Cornelia Hucka28c6942006-01-06 00:19:23 -0800747 }
Cornelia Hucka55360d2007-10-12 16:11:20 +0200748 ret = register_reboot_notifier(&css_reboot_notifier);
749 if (ret)
750 goto out_pseudo;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700751 css_init_done = 1;
752
753 ctl_set_bit(6, 28);
754
Cornelia Huckf97a56f2006-01-06 00:19:22 -0800755 for_each_subchannel(__init_channel_subsystem, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700756 return 0;
Cornelia Hucka55360d2007-10-12 16:11:20 +0200757out_pseudo:
758 device_unregister(&channel_subsystems[i]->pseudo_subchannel->dev);
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100759out_file:
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200760 device_remove_file(&channel_subsystems[i]->device,
761 &dev_attr_cm_enable);
Cornelia Huck7e560812006-07-12 16:40:19 +0200762out_device:
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200763 device_unregister(&channel_subsystems[i]->device);
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100764out_free_all:
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200765 kfree(channel_subsystems[i]->pseudo_subchannel->lock);
766 kfree(channel_subsystems[i]->pseudo_subchannel);
Cornelia Hucka28c6942006-01-06 00:19:23 -0800767out_free:
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200768 kfree(channel_subsystems[i]);
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800769out_unregister:
Cornelia Hucka28c6942006-01-06 00:19:23 -0800770 while (i > 0) {
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200771 struct channel_subsystem *css;
772
Cornelia Hucka28c6942006-01-06 00:19:23 -0800773 i--;
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200774 css = channel_subsystems[i];
775 device_unregister(&css->pseudo_subchannel->dev);
Cornelia Huck495a5b42006-03-24 03:15:14 -0800776 if (css_characteristics_avail && css_chsc_characteristics.secm)
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200777 device_remove_file(&css->device,
Cornelia Huck495a5b42006-03-24 03:15:14 -0800778 &dev_attr_cm_enable);
Cornelia Huck7c9f4e32007-10-12 16:11:13 +0200779 device_unregister(&css->device);
Cornelia Hucka28c6942006-01-06 00:19:23 -0800780 }
Cornelia Huckfb6958a2006-01-06 00:19:25 -0800781out_bus:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700782 bus_unregister(&css_bus_type);
783out:
Cornelia Huck4434a382007-07-27 12:29:21 +0200784 chsc_free_sei_area();
785 kfree(slow_subchannel_set);
786 printk(KERN_WARNING"cio: failed to initialize css driver (%d)!\n",
787 ret);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700788 return ret;
789}
790
Cornelia Huckd7b5a4c92006-12-08 15:54:28 +0100791int sch_is_pseudo_sch(struct subchannel *sch)
792{
793 return sch == to_css(sch->dev.parent)->pseudo_subchannel;
794}
795
Linus Torvalds1da177e2005-04-16 15:20:36 -0700796/*
797 * find a driver for a subchannel. They identify by the subchannel
798 * type with the exception that the console subchannel driver has its own
799 * subchannel type although the device is an i/o subchannel
800 */
801static int
802css_bus_match (struct device *dev, struct device_driver *drv)
803{
Cornelia Huck084325d2008-01-26 14:10:38 +0100804 struct subchannel *sch = to_subchannel(dev);
805 struct css_driver *driver = to_cssdriver(drv);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700806
807 if (sch->st == driver->subchannel_type)
808 return 1;
809
810 return 0;
811}
812
Cornelia Huck98c13c22008-01-26 14:10:40 +0100813static int css_probe(struct device *dev)
Cornelia Huck8bbace72006-01-11 10:56:22 +0100814{
815 struct subchannel *sch;
Cornelia Huck98c13c22008-01-26 14:10:40 +0100816 int ret;
Cornelia Huck8bbace72006-01-11 10:56:22 +0100817
818 sch = to_subchannel(dev);
Cornelia Huck084325d2008-01-26 14:10:38 +0100819 sch->driver = to_cssdriver(dev->driver);
Cornelia Huck98c13c22008-01-26 14:10:40 +0100820 ret = sch->driver->probe ? sch->driver->probe(sch) : 0;
821 if (ret)
822 sch->driver = NULL;
823 return ret;
Cornelia Huck8bbace72006-01-11 10:56:22 +0100824}
825
Cornelia Huck98c13c22008-01-26 14:10:40 +0100826static int css_remove(struct device *dev)
827{
828 struct subchannel *sch;
829 int ret;
830
831 sch = to_subchannel(dev);
832 ret = sch->driver->remove ? sch->driver->remove(sch) : 0;
833 sch->driver = NULL;
834 return ret;
835}
836
837static void css_shutdown(struct device *dev)
Cornelia Huck8bbace72006-01-11 10:56:22 +0100838{
839 struct subchannel *sch;
840
841 sch = to_subchannel(dev);
Cornelia Huck98c13c22008-01-26 14:10:40 +0100842 if (sch->driver && sch->driver->shutdown)
Cornelia Huck8bbace72006-01-11 10:56:22 +0100843 sch->driver->shutdown(sch);
844}
845
Linus Torvalds1da177e2005-04-16 15:20:36 -0700846struct bus_type css_bus_type = {
Cornelia Huck8bbace72006-01-11 10:56:22 +0100847 .name = "css",
848 .match = css_bus_match,
849 .probe = css_probe,
850 .remove = css_remove,
851 .shutdown = css_shutdown,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700852};
853
Cornelia Huck25b7bb52008-01-26 14:10:41 +0100854/**
855 * css_driver_register - register a css driver
856 * @cdrv: css driver to register
857 *
858 * This is mainly a wrapper around driver_register that sets name
859 * and bus_type in the embedded struct device_driver correctly.
860 */
861int css_driver_register(struct css_driver *cdrv)
862{
863 cdrv->drv.name = cdrv->name;
864 cdrv->drv.bus = &css_bus_type;
Cornelia Huck4beee642008-01-26 14:10:47 +0100865 cdrv->drv.owner = cdrv->owner;
Cornelia Huck25b7bb52008-01-26 14:10:41 +0100866 return driver_register(&cdrv->drv);
867}
868EXPORT_SYMBOL_GPL(css_driver_register);
869
870/**
871 * css_driver_unregister - unregister a css driver
872 * @cdrv: css driver to unregister
873 *
874 * This is a wrapper around driver_unregister.
875 */
876void css_driver_unregister(struct css_driver *cdrv)
877{
878 driver_unregister(&cdrv->drv);
879}
880EXPORT_SYMBOL_GPL(css_driver_unregister);
881
Linus Torvalds1da177e2005-04-16 15:20:36 -0700882subsys_initcall(init_channel_subsystem);
883
Linus Torvalds1da177e2005-04-16 15:20:36 -0700884MODULE_LICENSE("GPL");
885EXPORT_SYMBOL(css_bus_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700886EXPORT_SYMBOL_GPL(css_characteristics_avail);