blob: 0f8a25f98b10629de82b87591e3e669175cf4526 [file] [log] [blame]
Heiko Carstensf5daba12009-03-26 15:24:01 +01001/*
2 * Channel report handling code
3 *
Heiko Carstensa53c8fa2012-07-20 11:15:04 +02004 * Copyright IBM Corp. 2000, 2009
Heiko Carstensf5daba12009-03-26 15:24:01 +01005 * Author(s): Ingo Adlung <adlung@de.ibm.com>,
6 * Martin Schwidefsky <schwidefsky@de.ibm.com>,
7 * Cornelia Huck <cornelia.huck@de.ibm.com>,
8 * Heiko Carstens <heiko.carstens@de.ibm.com>,
9 */
10
Heiko Carstens98c1c682009-03-26 15:24:09 +010011#include <linux/mutex.h>
Heiko Carstensf5daba12009-03-26 15:24:01 +010012#include <linux/kthread.h>
13#include <linux/init.h>
Sebastian Ottb4563e82010-02-26 22:37:26 +010014#include <linux/wait.h>
Heiko Carstensf5daba12009-03-26 15:24:01 +010015#include <asm/crw.h>
David Howellsa0616cd2012-03-28 18:30:02 +010016#include <asm/ctl_reg.h>
Heiko Carstensf5daba12009-03-26 15:24:01 +010017
Heiko Carstens98c1c682009-03-26 15:24:09 +010018static DEFINE_MUTEX(crw_handler_mutex);
Heiko Carstensf5daba12009-03-26 15:24:01 +010019static crw_handler_t crw_handlers[NR_RSCS];
Sebastian Ottb4563e82010-02-26 22:37:26 +010020static atomic_t crw_nr_req = ATOMIC_INIT(0);
21static DECLARE_WAIT_QUEUE_HEAD(crw_handler_wait_q);
Heiko Carstensf5daba12009-03-26 15:24:01 +010022
23/**
24 * crw_register_handler() - register a channel report word handler
25 * @rsc: reporting source code to handle
26 * @handler: handler to be registered
27 *
28 * Returns %0 on success and a negative error value otherwise.
29 */
30int crw_register_handler(int rsc, crw_handler_t handler)
31{
Heiko Carstens98c1c682009-03-26 15:24:09 +010032 int rc = 0;
33
Heiko Carstensf5daba12009-03-26 15:24:01 +010034 if ((rsc < 0) || (rsc >= NR_RSCS))
35 return -EINVAL;
Heiko Carstens98c1c682009-03-26 15:24:09 +010036 mutex_lock(&crw_handler_mutex);
37 if (crw_handlers[rsc])
38 rc = -EBUSY;
39 else
40 crw_handlers[rsc] = handler;
41 mutex_unlock(&crw_handler_mutex);
42 return rc;
Heiko Carstensf5daba12009-03-26 15:24:01 +010043}
44
45/**
46 * crw_unregister_handler() - unregister a channel report word handler
47 * @rsc: reporting source code to handle
48 */
49void crw_unregister_handler(int rsc)
50{
51 if ((rsc < 0) || (rsc >= NR_RSCS))
52 return;
Heiko Carstens98c1c682009-03-26 15:24:09 +010053 mutex_lock(&crw_handler_mutex);
54 crw_handlers[rsc] = NULL;
55 mutex_unlock(&crw_handler_mutex);
Heiko Carstensf5daba12009-03-26 15:24:01 +010056}
57
58/*
59 * Retrieve CRWs and call function to handle event.
60 */
61static int crw_collect_info(void *unused)
62{
63 struct crw crw[2];
Sebastian Ottb4563e82010-02-26 22:37:26 +010064 int ccode, signal;
Heiko Carstensf5daba12009-03-26 15:24:01 +010065 unsigned int chain;
Heiko Carstensf5daba12009-03-26 15:24:01 +010066
67repeat:
Sebastian Ottb4563e82010-02-26 22:37:26 +010068 signal = wait_event_interruptible(crw_handler_wait_q,
69 atomic_read(&crw_nr_req) > 0);
70 if (unlikely(signal))
71 atomic_inc(&crw_nr_req);
Heiko Carstensf5daba12009-03-26 15:24:01 +010072 chain = 0;
73 while (1) {
Heiko Carstens98c1c682009-03-26 15:24:09 +010074 crw_handler_t handler;
75
Heiko Carstensf5daba12009-03-26 15:24:01 +010076 if (unlikely(chain > 1)) {
77 struct crw tmp_crw;
78
79 printk(KERN_WARNING"%s: Code does not support more "
80 "than two chained crws; please report to "
81 "linux390@de.ibm.com!\n", __func__);
82 ccode = stcrw(&tmp_crw);
83 printk(KERN_WARNING"%s: crw reports slct=%d, oflw=%d, "
84 "chn=%d, rsc=%X, anc=%d, erc=%X, rsid=%X\n",
85 __func__, tmp_crw.slct, tmp_crw.oflw,
86 tmp_crw.chn, tmp_crw.rsc, tmp_crw.anc,
87 tmp_crw.erc, tmp_crw.rsid);
88 printk(KERN_WARNING"%s: This was crw number %x in the "
89 "chain\n", __func__, chain);
90 if (ccode != 0)
91 break;
92 chain = tmp_crw.chn ? chain + 1 : 0;
93 continue;
94 }
95 ccode = stcrw(&crw[chain]);
96 if (ccode != 0)
97 break;
98 printk(KERN_DEBUG "crw_info : CRW reports slct=%d, oflw=%d, "
99 "chn=%d, rsc=%X, anc=%d, erc=%X, rsid=%X\n",
100 crw[chain].slct, crw[chain].oflw, crw[chain].chn,
101 crw[chain].rsc, crw[chain].anc, crw[chain].erc,
102 crw[chain].rsid);
103 /* Check for overflows. */
104 if (crw[chain].oflw) {
105 int i;
106
107 pr_debug("%s: crw overflow detected!\n", __func__);
Heiko Carstens98c1c682009-03-26 15:24:09 +0100108 mutex_lock(&crw_handler_mutex);
Heiko Carstensf5daba12009-03-26 15:24:01 +0100109 for (i = 0; i < NR_RSCS; i++) {
110 if (crw_handlers[i])
111 crw_handlers[i](NULL, NULL, 1);
112 }
Heiko Carstens98c1c682009-03-26 15:24:09 +0100113 mutex_unlock(&crw_handler_mutex);
Heiko Carstensf5daba12009-03-26 15:24:01 +0100114 chain = 0;
115 continue;
116 }
117 if (crw[0].chn && !chain) {
118 chain++;
119 continue;
120 }
Heiko Carstens98c1c682009-03-26 15:24:09 +0100121 mutex_lock(&crw_handler_mutex);
122 handler = crw_handlers[crw[chain].rsc];
123 if (handler)
124 handler(&crw[0], chain ? &crw[1] : NULL, 0);
125 mutex_unlock(&crw_handler_mutex);
Heiko Carstensf5daba12009-03-26 15:24:01 +0100126 /* chain is always 0 or 1 here. */
127 chain = crw[chain].chn ? chain + 1 : 0;
128 }
Sebastian Ottb4563e82010-02-26 22:37:26 +0100129 if (atomic_dec_and_test(&crw_nr_req))
130 wake_up(&crw_handler_wait_q);
Heiko Carstensf5daba12009-03-26 15:24:01 +0100131 goto repeat;
132 return 0;
133}
134
135void crw_handle_channel_report(void)
136{
Sebastian Ottb4563e82010-02-26 22:37:26 +0100137 atomic_inc(&crw_nr_req);
138 wake_up(&crw_handler_wait_q);
Heiko Carstensf5daba12009-03-26 15:24:01 +0100139}
140
Sebastian Ottb4563e82010-02-26 22:37:26 +0100141void crw_wait_for_channel_report(void)
Heiko Carstensf5daba12009-03-26 15:24:01 +0100142{
Sebastian Ottb4563e82010-02-26 22:37:26 +0100143 crw_handle_channel_report();
144 wait_event(crw_handler_wait_q, atomic_read(&crw_nr_req) == 0);
Heiko Carstensf5daba12009-03-26 15:24:01 +0100145}
Heiko Carstensf5daba12009-03-26 15:24:01 +0100146
147/*
148 * Machine checks for the channel subsystem must be enabled
149 * after the channel subsystem is initialized
150 */
151static int __init crw_machine_check_init(void)
152{
153 struct task_struct *task;
154
155 task = kthread_run(crw_collect_info, NULL, "kmcheck");
156 if (IS_ERR(task))
157 return PTR_ERR(task);
158 ctl_set_bit(14, 28); /* enable channel report MCH */
159 return 0;
160}
161device_initcall(crw_machine_check_init);