Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
e018ba1f | 2 | * linux/drivers/s390/cio/cmf.c |
1da177e4 LT |
3 | * |
4 | * Linux on zSeries Channel Measurement Facility support | |
5 | * | |
94bb0633 | 6 | * Copyright 2000,2006 IBM Corporation |
1da177e4 | 7 | * |
94bb0633 CH |
8 | * Authors: Arnd Bergmann <arndb@de.ibm.com> |
9 | * Cornelia Huck <cornelia.huck@de.ibm.com> | |
1da177e4 LT |
10 | * |
11 | * original idea from Natarajan Krishnaswami <nkrishna@us.ibm.com> | |
12 | * | |
13 | * This program is free software; you can redistribute it and/or modify | |
14 | * it under the terms of the GNU General Public License as published by | |
15 | * the Free Software Foundation; either version 2, or (at your option) | |
16 | * any later version. | |
17 | * | |
18 | * This program is distributed in the hope that it will be useful, | |
19 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
20 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
21 | * GNU General Public License for more details. | |
22 | * | |
23 | * You should have received a copy of the GNU General Public License | |
24 | * along with this program; if not, write to the Free Software | |
25 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
26 | */ | |
27 | ||
e6d5a428 ME |
28 | #define KMSG_COMPONENT "cio" |
29 | #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt | |
30 | ||
1da177e4 LT |
31 | #include <linux/bootmem.h> |
32 | #include <linux/device.h> | |
33 | #include <linux/init.h> | |
34 | #include <linux/list.h> | |
35 | #include <linux/module.h> | |
36 | #include <linux/moduleparam.h> | |
4e57b681 TS |
37 | #include <linux/slab.h> |
38 | #include <linux/timex.h> /* get_clock() */ | |
1da177e4 LT |
39 | |
40 | #include <asm/ccwdev.h> | |
41 | #include <asm/cio.h> | |
42 | #include <asm/cmb.h> | |
4e57b681 | 43 | #include <asm/div64.h> |
1da177e4 LT |
44 | |
45 | #include "cio.h" | |
46 | #include "css.h" | |
47 | #include "device.h" | |
48 | #include "ioasm.h" | |
49 | #include "chsc.h" | |
50 | ||
fc5019c5 CH |
51 | /* |
52 | * parameter to enable cmf during boot, possible uses are: | |
1da177e4 LT |
53 | * "s390cmf" -- enable cmf and allocate 2 MB of ram so measuring can be |
54 | * used on any subchannel | |
55 | * "s390cmf=<num>" -- enable cmf and allocate enough memory to measure | |
56 | * <num> subchannel, where <num> is an integer | |
57 | * between 1 and 65535, default is 1024 | |
58 | */ | |
59 | #define ARGSTRING "s390cmf" | |
60 | ||
61 | /* indices for READCMB */ | |
62 | enum cmb_index { | |
63 | /* basic and exended format: */ | |
64 | cmb_ssch_rsch_count, | |
65 | cmb_sample_count, | |
66 | cmb_device_connect_time, | |
67 | cmb_function_pending_time, | |
68 | cmb_device_disconnect_time, | |
69 | cmb_control_unit_queuing_time, | |
70 | cmb_device_active_only_time, | |
71 | /* extended format only: */ | |
72 | cmb_device_busy_time, | |
73 | cmb_initial_command_response_time, | |
74 | }; | |
75 | ||
76 | /** | |
77 | * enum cmb_format - types of supported measurement block formats | |
78 | * | |
79 | * @CMF_BASIC: traditional channel measurement blocks supported | |
c0208716 | 80 | * by all machines that we run on |
1da177e4 | 81 | * @CMF_EXTENDED: improved format that was introduced with the z990 |
c0208716 CH |
82 | * machine |
83 | * @CMF_AUTODETECT: default: use extended format when running on a machine | |
84 | * supporting extended format, otherwise fall back to | |
85 | * basic format | |
86 | */ | |
1da177e4 LT |
87 | enum cmb_format { |
88 | CMF_BASIC, | |
89 | CMF_EXTENDED, | |
90 | CMF_AUTODETECT = -1, | |
91 | }; | |
fc5019c5 | 92 | |
c0208716 | 93 | /* |
1da177e4 LT |
94 | * format - actual format for all measurement blocks |
95 | * | |
96 | * The format module parameter can be set to a value of 0 (zero) | |
97 | * or 1, indicating basic or extended format as described for | |
98 | * enum cmb_format. | |
99 | */ | |
100 | static int format = CMF_AUTODETECT; | |
101 | module_param(format, bool, 0444); | |
102 | ||
103 | /** | |
104 | * struct cmb_operations - functions to use depending on cmb_format | |
105 | * | |
94bb0633 CH |
106 | * Most of these functions operate on a struct ccw_device. There is only |
107 | * one instance of struct cmb_operations because the format of the measurement | |
108 | * data is guaranteed to be the same for every ccw_device. | |
1da177e4 LT |
109 | * |
110 | * @alloc: allocate memory for a channel measurement block, | |
111 | * either with the help of a special pool or with kmalloc | |
112 | * @free: free memory allocated with @alloc | |
113 | * @set: enable or disable measurement | |
c0208716 | 114 | * @read: read a measurement entry at an index |
1da177e4 LT |
115 | * @readall: read a measurement block in a common format |
116 | * @reset: clear the data in the associated measurement block and | |
117 | * reset its time stamp | |
94bb0633 | 118 | * @align: align an allocated block so that the hardware can use it |
1da177e4 LT |
119 | */ |
120 | struct cmb_operations { | |
fc5019c5 CH |
121 | int (*alloc) (struct ccw_device *); |
122 | void (*free) (struct ccw_device *); | |
123 | int (*set) (struct ccw_device *, u32); | |
124 | u64 (*read) (struct ccw_device *, int); | |
125 | int (*readall)(struct ccw_device *, struct cmbdata *); | |
126 | void (*reset) (struct ccw_device *); | |
127 | void *(*align) (void *); | |
c0208716 | 128 | /* private: */ |
1da177e4 LT |
129 | struct attribute_group *attr_group; |
130 | }; | |
131 | static struct cmb_operations *cmbops; | |
132 | ||
94bb0633 CH |
133 | struct cmb_data { |
134 | void *hw_block; /* Pointer to block updated by hardware */ | |
135 | void *last_block; /* Last changed block copied from hardware block */ | |
136 | int size; /* Size of hw_block and last_block */ | |
137 | unsigned long long last_update; /* when last_block was updated */ | |
138 | }; | |
139 | ||
fc5019c5 CH |
140 | /* |
141 | * Our user interface is designed in terms of nanoseconds, | |
1da177e4 | 142 | * while the hardware measures total times in its own |
fc5019c5 CH |
143 | * unit. |
144 | */ | |
1da177e4 LT |
145 | static inline u64 time_to_nsec(u32 value) |
146 | { | |
147 | return ((u64)value) * 128000ull; | |
148 | } | |
149 | ||
150 | /* | |
151 | * Users are usually interested in average times, | |
152 | * not accumulated time. | |
153 | * This also helps us with atomicity problems | |
154 | * when reading sinlge values. | |
155 | */ | |
156 | static inline u64 time_to_avg_nsec(u32 value, u32 count) | |
157 | { | |
158 | u64 ret; | |
159 | ||
160 | /* no samples yet, avoid division by 0 */ | |
161 | if (count == 0) | |
162 | return 0; | |
163 | ||
96de0e25 | 164 | /* value comes in units of 128 µsec */ |
1da177e4 LT |
165 | ret = time_to_nsec(value); |
166 | do_div(ret, count); | |
167 | ||
168 | return ret; | |
169 | } | |
170 | ||
fc5019c5 CH |
171 | /* |
172 | * Activate or deactivate the channel monitor. When area is NULL, | |
1da177e4 LT |
173 | * the monitor is deactivated. The channel monitor needs to |
174 | * be active in order to measure subchannels, which also need | |
fc5019c5 CH |
175 | * to be enabled. |
176 | */ | |
177 | static inline void cmf_activate(void *area, unsigned int onoff) | |
1da177e4 LT |
178 | { |
179 | register void * __gpr2 asm("2"); | |
180 | register long __gpr1 asm("1"); | |
181 | ||
182 | __gpr2 = area; | |
183 | __gpr1 = onoff ? 2 : 0; | |
184 | /* activate channel measurement */ | |
185 | asm("schm" : : "d" (__gpr2), "d" (__gpr1) ); | |
186 | } | |
187 | ||
fc5019c5 CH |
188 | static int set_schib(struct ccw_device *cdev, u32 mme, int mbfc, |
189 | unsigned long address) | |
1da177e4 | 190 | { |
1da177e4 | 191 | struct subchannel *sch; |
1da177e4 LT |
192 | |
193 | sch = to_subchannel(cdev->dev.parent); | |
1da177e4 | 194 | |
13952ec1 SO |
195 | sch->config.mme = mme; |
196 | sch->config.mbfc = mbfc; | |
197 | /* address can be either a block address or a block index */ | |
198 | if (mbfc) | |
199 | sch->config.mba = address; | |
200 | else | |
201 | sch->config.mbi = address; | |
1da177e4 | 202 | |
13952ec1 | 203 | return cio_commit_config(sch); |
1da177e4 LT |
204 | } |
205 | ||
206 | struct set_schib_struct { | |
207 | u32 mme; | |
208 | int mbfc; | |
209 | unsigned long address; | |
210 | wait_queue_head_t wait; | |
211 | int ret; | |
94bb0633 | 212 | struct kref kref; |
1da177e4 LT |
213 | }; |
214 | ||
94bb0633 CH |
215 | static void cmf_set_schib_release(struct kref *kref) |
216 | { | |
217 | struct set_schib_struct *set_data; | |
218 | ||
219 | set_data = container_of(kref, struct set_schib_struct, kref); | |
220 | kfree(set_data); | |
221 | } | |
222 | ||
223 | #define CMF_PENDING 1 | |
224 | ||
1da177e4 LT |
225 | static int set_schib_wait(struct ccw_device *cdev, u32 mme, |
226 | int mbfc, unsigned long address) | |
227 | { | |
94bb0633 CH |
228 | struct set_schib_struct *set_data; |
229 | int ret; | |
1da177e4 LT |
230 | |
231 | spin_lock_irq(cdev->ccwlock); | |
94bb0633 CH |
232 | if (!cdev->private->cmb) { |
233 | ret = -ENODEV; | |
234 | goto out; | |
1da177e4 | 235 | } |
94bb0633 CH |
236 | set_data = kzalloc(sizeof(struct set_schib_struct), GFP_ATOMIC); |
237 | if (!set_data) { | |
238 | ret = -ENOMEM; | |
239 | goto out; | |
240 | } | |
241 | init_waitqueue_head(&set_data->wait); | |
242 | kref_init(&set_data->kref); | |
243 | set_data->mme = mme; | |
244 | set_data->mbfc = mbfc; | |
245 | set_data->address = address; | |
246 | ||
247 | ret = set_schib(cdev, mme, mbfc, address); | |
248 | if (ret != -EBUSY) | |
249 | goto out_put; | |
1da177e4 LT |
250 | |
251 | if (cdev->private->state != DEV_STATE_ONLINE) { | |
1da177e4 | 252 | /* if the device is not online, don't even try again */ |
94bb0633 CH |
253 | ret = -EBUSY; |
254 | goto out_put; | |
1da177e4 | 255 | } |
94bb0633 | 256 | |
1da177e4 | 257 | cdev->private->state = DEV_STATE_CMFCHANGE; |
94bb0633 CH |
258 | set_data->ret = CMF_PENDING; |
259 | cdev->private->cmb_wait = set_data; | |
1da177e4 LT |
260 | |
261 | spin_unlock_irq(cdev->ccwlock); | |
94bb0633 CH |
262 | if (wait_event_interruptible(set_data->wait, |
263 | set_data->ret != CMF_PENDING)) { | |
1da177e4 | 264 | spin_lock_irq(cdev->ccwlock); |
94bb0633 CH |
265 | if (set_data->ret == CMF_PENDING) { |
266 | set_data->ret = -ERESTARTSYS; | |
1da177e4 LT |
267 | if (cdev->private->state == DEV_STATE_CMFCHANGE) |
268 | cdev->private->state = DEV_STATE_ONLINE; | |
269 | } | |
270 | spin_unlock_irq(cdev->ccwlock); | |
271 | } | |
94bb0633 CH |
272 | spin_lock_irq(cdev->ccwlock); |
273 | cdev->private->cmb_wait = NULL; | |
274 | ret = set_data->ret; | |
275 | out_put: | |
276 | kref_put(&set_data->kref, cmf_set_schib_release); | |
277 | out: | |
1da177e4 | 278 | spin_unlock_irq(cdev->ccwlock); |
94bb0633 | 279 | return ret; |
1da177e4 LT |
280 | } |
281 | ||
282 | void retry_set_schib(struct ccw_device *cdev) | |
283 | { | |
94bb0633 CH |
284 | struct set_schib_struct *set_data; |
285 | ||
286 | set_data = cdev->private->cmb_wait; | |
287 | if (!set_data) { | |
288 | WARN_ON(1); | |
289 | return; | |
290 | } | |
291 | kref_get(&set_data->kref); | |
292 | set_data->ret = set_schib(cdev, set_data->mme, set_data->mbfc, | |
293 | set_data->address); | |
294 | wake_up(&set_data->wait); | |
295 | kref_put(&set_data->kref, cmf_set_schib_release); | |
296 | } | |
297 | ||
298 | static int cmf_copy_block(struct ccw_device *cdev) | |
299 | { | |
300 | struct subchannel *sch; | |
301 | void *reference_buf; | |
302 | void *hw_block; | |
303 | struct cmb_data *cmb_data; | |
304 | ||
305 | sch = to_subchannel(cdev->dev.parent); | |
306 | ||
cdb912a4 | 307 | if (cio_update_schib(sch)) |
94bb0633 CH |
308 | return -ENODEV; |
309 | ||
23d805b6 | 310 | if (scsw_fctl(&sch->schib.scsw) & SCSW_FCTL_START_FUNC) { |
94bb0633 | 311 | /* Don't copy if a start function is in progress. */ |
23d805b6 PO |
312 | if ((!(scsw_actl(&sch->schib.scsw) & SCSW_ACTL_SUSPENDED)) && |
313 | (scsw_actl(&sch->schib.scsw) & | |
94bb0633 | 314 | (SCSW_ACTL_DEVACT | SCSW_ACTL_SCHACT)) && |
23d805b6 | 315 | (!(scsw_stctl(&sch->schib.scsw) & SCSW_STCTL_SEC_STATUS))) |
94bb0633 CH |
316 | return -EBUSY; |
317 | } | |
318 | cmb_data = cdev->private->cmb; | |
319 | hw_block = cmbops->align(cmb_data->hw_block); | |
320 | if (!memcmp(cmb_data->last_block, hw_block, cmb_data->size)) | |
321 | /* No need to copy. */ | |
322 | return 0; | |
323 | reference_buf = kzalloc(cmb_data->size, GFP_ATOMIC); | |
324 | if (!reference_buf) | |
325 | return -ENOMEM; | |
326 | /* Ensure consistency of block copied from hardware. */ | |
327 | do { | |
328 | memcpy(cmb_data->last_block, hw_block, cmb_data->size); | |
329 | memcpy(reference_buf, hw_block, cmb_data->size); | |
330 | } while (memcmp(cmb_data->last_block, reference_buf, cmb_data->size)); | |
331 | cmb_data->last_update = get_clock(); | |
332 | kfree(reference_buf); | |
333 | return 0; | |
334 | } | |
335 | ||
336 | struct copy_block_struct { | |
337 | wait_queue_head_t wait; | |
338 | int ret; | |
339 | struct kref kref; | |
340 | }; | |
341 | ||
342 | static void cmf_copy_block_release(struct kref *kref) | |
343 | { | |
344 | struct copy_block_struct *copy_block; | |
345 | ||
346 | copy_block = container_of(kref, struct copy_block_struct, kref); | |
347 | kfree(copy_block); | |
348 | } | |
349 | ||
350 | static int cmf_cmb_copy_wait(struct ccw_device *cdev) | |
351 | { | |
352 | struct copy_block_struct *copy_block; | |
353 | int ret; | |
354 | unsigned long flags; | |
355 | ||
356 | spin_lock_irqsave(cdev->ccwlock, flags); | |
357 | if (!cdev->private->cmb) { | |
358 | ret = -ENODEV; | |
359 | goto out; | |
360 | } | |
361 | copy_block = kzalloc(sizeof(struct copy_block_struct), GFP_ATOMIC); | |
362 | if (!copy_block) { | |
363 | ret = -ENOMEM; | |
364 | goto out; | |
365 | } | |
366 | init_waitqueue_head(©_block->wait); | |
367 | kref_init(©_block->kref); | |
368 | ||
369 | ret = cmf_copy_block(cdev); | |
370 | if (ret != -EBUSY) | |
371 | goto out_put; | |
372 | ||
373 | if (cdev->private->state != DEV_STATE_ONLINE) { | |
374 | ret = -EBUSY; | |
375 | goto out_put; | |
376 | } | |
377 | ||
378 | cdev->private->state = DEV_STATE_CMFUPDATE; | |
379 | copy_block->ret = CMF_PENDING; | |
380 | cdev->private->cmb_wait = copy_block; | |
381 | ||
382 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
383 | if (wait_event_interruptible(copy_block->wait, | |
384 | copy_block->ret != CMF_PENDING)) { | |
385 | spin_lock_irqsave(cdev->ccwlock, flags); | |
386 | if (copy_block->ret == CMF_PENDING) { | |
387 | copy_block->ret = -ERESTARTSYS; | |
388 | if (cdev->private->state == DEV_STATE_CMFUPDATE) | |
389 | cdev->private->state = DEV_STATE_ONLINE; | |
390 | } | |
391 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
392 | } | |
393 | spin_lock_irqsave(cdev->ccwlock, flags); | |
394 | cdev->private->cmb_wait = NULL; | |
395 | ret = copy_block->ret; | |
396 | out_put: | |
397 | kref_put(©_block->kref, cmf_copy_block_release); | |
398 | out: | |
399 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
400 | return ret; | |
401 | } | |
402 | ||
403 | void cmf_retry_copy_block(struct ccw_device *cdev) | |
404 | { | |
405 | struct copy_block_struct *copy_block; | |
1da177e4 | 406 | |
94bb0633 CH |
407 | copy_block = cdev->private->cmb_wait; |
408 | if (!copy_block) { | |
1da177e4 LT |
409 | WARN_ON(1); |
410 | return; | |
411 | } | |
94bb0633 CH |
412 | kref_get(©_block->kref); |
413 | copy_block->ret = cmf_copy_block(cdev); | |
414 | wake_up(©_block->wait); | |
415 | kref_put(©_block->kref, cmf_copy_block_release); | |
416 | } | |
417 | ||
418 | static void cmf_generic_reset(struct ccw_device *cdev) | |
419 | { | |
420 | struct cmb_data *cmb_data; | |
421 | ||
422 | spin_lock_irq(cdev->ccwlock); | |
423 | cmb_data = cdev->private->cmb; | |
424 | if (cmb_data) { | |
425 | memset(cmb_data->last_block, 0, cmb_data->size); | |
426 | /* | |
427 | * Need to reset hw block as well to make the hardware start | |
428 | * from 0 again. | |
429 | */ | |
430 | memset(cmbops->align(cmb_data->hw_block), 0, cmb_data->size); | |
431 | cmb_data->last_update = 0; | |
432 | } | |
433 | cdev->private->cmb_start_time = get_clock(); | |
434 | spin_unlock_irq(cdev->ccwlock); | |
1da177e4 LT |
435 | } |
436 | ||
437 | /** | |
438 | * struct cmb_area - container for global cmb data | |
439 | * | |
440 | * @mem: pointer to CMBs (only in basic measurement mode) | |
441 | * @list: contains a linked list of all subchannels | |
c0208716 | 442 | * @num_channels: number of channels to be measured |
1da177e4 LT |
443 | * @lock: protect concurrent access to @mem and @list |
444 | */ | |
445 | struct cmb_area { | |
446 | struct cmb *mem; | |
447 | struct list_head list; | |
448 | int num_channels; | |
449 | spinlock_t lock; | |
450 | }; | |
451 | ||
452 | static struct cmb_area cmb_area = { | |
cb629a01 | 453 | .lock = __SPIN_LOCK_UNLOCKED(cmb_area.lock), |
1da177e4 LT |
454 | .list = LIST_HEAD_INIT(cmb_area.list), |
455 | .num_channels = 1024, | |
456 | }; | |
457 | ||
1da177e4 LT |
458 | /* ****** old style CMB handling ********/ |
459 | ||
fc5019c5 | 460 | /* |
1da177e4 LT |
461 | * Basic channel measurement blocks are allocated in one contiguous |
462 | * block of memory, which can not be moved as long as any channel | |
463 | * is active. Therefore, a maximum number of subchannels needs to | |
464 | * be defined somewhere. This is a module parameter, defaulting to | |
465 | * a resonable value of 1024, or 32 kb of memory. | |
466 | * Current kernels don't allow kmalloc with more than 128kb, so the | |
fc5019c5 | 467 | * maximum is 4096. |
1da177e4 LT |
468 | */ |
469 | ||
470 | module_param_named(maxchannels, cmb_area.num_channels, uint, 0444); | |
471 | ||
472 | /** | |
473 | * struct cmb - basic channel measurement block | |
c0208716 CH |
474 | * @ssch_rsch_count: number of ssch and rsch |
475 | * @sample_count: number of samples | |
476 | * @device_connect_time: time of device connect | |
477 | * @function_pending_time: time of function pending | |
478 | * @device_disconnect_time: time of device disconnect | |
479 | * @control_unit_queuing_time: time of control unit queuing | |
480 | * @device_active_only_time: time of device active only | |
481 | * @reserved: unused in basic measurement mode | |
482 | * | |
483 | * The measurement block as used by the hardware. The fields are described | |
484 | * further in z/Architecture Principles of Operation, chapter 17. | |
1da177e4 | 485 | * |
c0208716 CH |
486 | * The cmb area made up from these blocks must be a contiguous array and may |
487 | * not be reallocated or freed. | |
1da177e4 LT |
488 | * Only one cmb area can be present in the system. |
489 | */ | |
490 | struct cmb { | |
491 | u16 ssch_rsch_count; | |
492 | u16 sample_count; | |
493 | u32 device_connect_time; | |
494 | u32 function_pending_time; | |
495 | u32 device_disconnect_time; | |
496 | u32 control_unit_queuing_time; | |
497 | u32 device_active_only_time; | |
498 | u32 reserved[2]; | |
499 | }; | |
500 | ||
fc5019c5 CH |
501 | /* |
502 | * Insert a single device into the cmb_area list. | |
503 | * Called with cmb_area.lock held from alloc_cmb. | |
1da177e4 | 504 | */ |
4d284cac HC |
505 | static int alloc_cmb_single(struct ccw_device *cdev, |
506 | struct cmb_data *cmb_data) | |
1da177e4 LT |
507 | { |
508 | struct cmb *cmb; | |
509 | struct ccw_device_private *node; | |
510 | int ret; | |
511 | ||
512 | spin_lock_irq(cdev->ccwlock); | |
513 | if (!list_empty(&cdev->private->cmb_list)) { | |
514 | ret = -EBUSY; | |
515 | goto out; | |
516 | } | |
517 | ||
fc5019c5 CH |
518 | /* |
519 | * Find first unused cmb in cmb_area.mem. | |
520 | * This is a little tricky: cmb_area.list | |
521 | * remains sorted by ->cmb->hw_data pointers. | |
522 | */ | |
1da177e4 LT |
523 | cmb = cmb_area.mem; |
524 | list_for_each_entry(node, &cmb_area.list, cmb_list) { | |
94bb0633 CH |
525 | struct cmb_data *data; |
526 | data = node->cmb; | |
527 | if ((struct cmb*)data->hw_block > cmb) | |
1da177e4 LT |
528 | break; |
529 | cmb++; | |
530 | } | |
531 | if (cmb - cmb_area.mem >= cmb_area.num_channels) { | |
532 | ret = -ENOMEM; | |
533 | goto out; | |
534 | } | |
535 | ||
536 | /* insert new cmb */ | |
537 | list_add_tail(&cdev->private->cmb_list, &node->cmb_list); | |
94bb0633 CH |
538 | cmb_data->hw_block = cmb; |
539 | cdev->private->cmb = cmb_data; | |
1da177e4 LT |
540 | ret = 0; |
541 | out: | |
542 | spin_unlock_irq(cdev->ccwlock); | |
543 | return ret; | |
544 | } | |
545 | ||
fc5019c5 | 546 | static int alloc_cmb(struct ccw_device *cdev) |
1da177e4 LT |
547 | { |
548 | int ret; | |
549 | struct cmb *mem; | |
550 | ssize_t size; | |
94bb0633 CH |
551 | struct cmb_data *cmb_data; |
552 | ||
553 | /* Allocate private cmb_data. */ | |
554 | cmb_data = kzalloc(sizeof(struct cmb_data), GFP_KERNEL); | |
555 | if (!cmb_data) | |
556 | return -ENOMEM; | |
1da177e4 | 557 | |
94bb0633 CH |
558 | cmb_data->last_block = kzalloc(sizeof(struct cmb), GFP_KERNEL); |
559 | if (!cmb_data->last_block) { | |
560 | kfree(cmb_data); | |
561 | return -ENOMEM; | |
562 | } | |
563 | cmb_data->size = sizeof(struct cmb); | |
1da177e4 LT |
564 | spin_lock(&cmb_area.lock); |
565 | ||
566 | if (!cmb_area.mem) { | |
567 | /* there is no user yet, so we need a new area */ | |
568 | size = sizeof(struct cmb) * cmb_area.num_channels; | |
569 | WARN_ON(!list_empty(&cmb_area.list)); | |
570 | ||
571 | spin_unlock(&cmb_area.lock); | |
572 | mem = (void*)__get_free_pages(GFP_KERNEL | GFP_DMA, | |
573 | get_order(size)); | |
574 | spin_lock(&cmb_area.lock); | |
575 | ||
576 | if (cmb_area.mem) { | |
577 | /* ok, another thread was faster */ | |
578 | free_pages((unsigned long)mem, get_order(size)); | |
579 | } else if (!mem) { | |
580 | /* no luck */ | |
581 | ret = -ENOMEM; | |
582 | goto out; | |
583 | } else { | |
584 | /* everything ok */ | |
585 | memset(mem, 0, size); | |
586 | cmb_area.mem = mem; | |
587 | cmf_activate(cmb_area.mem, 1); | |
588 | } | |
589 | } | |
590 | ||
591 | /* do the actual allocation */ | |
94bb0633 | 592 | ret = alloc_cmb_single(cdev, cmb_data); |
1da177e4 LT |
593 | out: |
594 | spin_unlock(&cmb_area.lock); | |
94bb0633 CH |
595 | if (ret) { |
596 | kfree(cmb_data->last_block); | |
597 | kfree(cmb_data); | |
598 | } | |
1da177e4 LT |
599 | return ret; |
600 | } | |
601 | ||
94bb0633 | 602 | static void free_cmb(struct ccw_device *cdev) |
1da177e4 LT |
603 | { |
604 | struct ccw_device_private *priv; | |
94bb0633 | 605 | struct cmb_data *cmb_data; |
1da177e4 LT |
606 | |
607 | spin_lock(&cmb_area.lock); | |
608 | spin_lock_irq(cdev->ccwlock); | |
609 | ||
94bb0633 CH |
610 | priv = cdev->private; |
611 | ||
1da177e4 LT |
612 | if (list_empty(&priv->cmb_list)) { |
613 | /* already freed */ | |
614 | goto out; | |
615 | } | |
616 | ||
94bb0633 | 617 | cmb_data = priv->cmb; |
1da177e4 | 618 | priv->cmb = NULL; |
94bb0633 CH |
619 | if (cmb_data) |
620 | kfree(cmb_data->last_block); | |
621 | kfree(cmb_data); | |
1da177e4 LT |
622 | list_del_init(&priv->cmb_list); |
623 | ||
624 | if (list_empty(&cmb_area.list)) { | |
625 | ssize_t size; | |
626 | size = sizeof(struct cmb) * cmb_area.num_channels; | |
627 | cmf_activate(NULL, 0); | |
628 | free_pages((unsigned long)cmb_area.mem, get_order(size)); | |
629 | cmb_area.mem = NULL; | |
630 | } | |
631 | out: | |
632 | spin_unlock_irq(cdev->ccwlock); | |
633 | spin_unlock(&cmb_area.lock); | |
634 | } | |
635 | ||
94bb0633 | 636 | static int set_cmb(struct ccw_device *cdev, u32 mme) |
1da177e4 LT |
637 | { |
638 | u16 offset; | |
94bb0633 CH |
639 | struct cmb_data *cmb_data; |
640 | unsigned long flags; | |
1da177e4 | 641 | |
94bb0633 CH |
642 | spin_lock_irqsave(cdev->ccwlock, flags); |
643 | if (!cdev->private->cmb) { | |
644 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
1da177e4 | 645 | return -EINVAL; |
94bb0633 CH |
646 | } |
647 | cmb_data = cdev->private->cmb; | |
648 | offset = mme ? (struct cmb *)cmb_data->hw_block - cmb_area.mem : 0; | |
649 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
1da177e4 LT |
650 | |
651 | return set_schib_wait(cdev, mme, 0, offset); | |
652 | } | |
653 | ||
fc5019c5 | 654 | static u64 read_cmb(struct ccw_device *cdev, int index) |
1da177e4 | 655 | { |
94bb0633 | 656 | struct cmb *cmb; |
1da177e4 | 657 | u32 val; |
94bb0633 CH |
658 | int ret; |
659 | unsigned long flags; | |
660 | ||
661 | ret = cmf_cmb_copy_wait(cdev); | |
662 | if (ret < 0) | |
663 | return 0; | |
1da177e4 LT |
664 | |
665 | spin_lock_irqsave(cdev->ccwlock, flags); | |
666 | if (!cdev->private->cmb) { | |
94bb0633 CH |
667 | ret = 0; |
668 | goto out; | |
1da177e4 | 669 | } |
94bb0633 | 670 | cmb = ((struct cmb_data *)cdev->private->cmb)->last_block; |
1da177e4 LT |
671 | |
672 | switch (index) { | |
673 | case cmb_ssch_rsch_count: | |
94bb0633 CH |
674 | ret = cmb->ssch_rsch_count; |
675 | goto out; | |
1da177e4 | 676 | case cmb_sample_count: |
94bb0633 CH |
677 | ret = cmb->sample_count; |
678 | goto out; | |
1da177e4 | 679 | case cmb_device_connect_time: |
94bb0633 | 680 | val = cmb->device_connect_time; |
1da177e4 LT |
681 | break; |
682 | case cmb_function_pending_time: | |
94bb0633 | 683 | val = cmb->function_pending_time; |
1da177e4 LT |
684 | break; |
685 | case cmb_device_disconnect_time: | |
94bb0633 | 686 | val = cmb->device_disconnect_time; |
1da177e4 LT |
687 | break; |
688 | case cmb_control_unit_queuing_time: | |
94bb0633 | 689 | val = cmb->control_unit_queuing_time; |
1da177e4 LT |
690 | break; |
691 | case cmb_device_active_only_time: | |
94bb0633 | 692 | val = cmb->device_active_only_time; |
1da177e4 LT |
693 | break; |
694 | default: | |
94bb0633 CH |
695 | ret = 0; |
696 | goto out; | |
1da177e4 | 697 | } |
94bb0633 CH |
698 | ret = time_to_avg_nsec(val, cmb->sample_count); |
699 | out: | |
700 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
701 | return ret; | |
1da177e4 LT |
702 | } |
703 | ||
fc5019c5 | 704 | static int readall_cmb(struct ccw_device *cdev, struct cmbdata *data) |
1da177e4 | 705 | { |
94bb0633 CH |
706 | struct cmb *cmb; |
707 | struct cmb_data *cmb_data; | |
1da177e4 | 708 | u64 time; |
94bb0633 CH |
709 | unsigned long flags; |
710 | int ret; | |
1da177e4 | 711 | |
94bb0633 CH |
712 | ret = cmf_cmb_copy_wait(cdev); |
713 | if (ret < 0) | |
714 | return ret; | |
1da177e4 | 715 | spin_lock_irqsave(cdev->ccwlock, flags); |
94bb0633 CH |
716 | cmb_data = cdev->private->cmb; |
717 | if (!cmb_data) { | |
718 | ret = -ENODEV; | |
719 | goto out; | |
1da177e4 | 720 | } |
94bb0633 CH |
721 | if (cmb_data->last_update == 0) { |
722 | ret = -EAGAIN; | |
723 | goto out; | |
724 | } | |
725 | cmb = cmb_data->last_block; | |
726 | time = cmb_data->last_update - cdev->private->cmb_start_time; | |
1da177e4 LT |
727 | |
728 | memset(data, 0, sizeof(struct cmbdata)); | |
729 | ||
730 | /* we only know values before device_busy_time */ | |
731 | data->size = offsetof(struct cmbdata, device_busy_time); | |
732 | ||
733 | /* convert to nanoseconds */ | |
734 | data->elapsed_time = (time * 1000) >> 12; | |
735 | ||
736 | /* copy data to new structure */ | |
94bb0633 CH |
737 | data->ssch_rsch_count = cmb->ssch_rsch_count; |
738 | data->sample_count = cmb->sample_count; | |
1da177e4 LT |
739 | |
740 | /* time fields are converted to nanoseconds while copying */ | |
94bb0633 CH |
741 | data->device_connect_time = time_to_nsec(cmb->device_connect_time); |
742 | data->function_pending_time = time_to_nsec(cmb->function_pending_time); | |
743 | data->device_disconnect_time = | |
744 | time_to_nsec(cmb->device_disconnect_time); | |
1da177e4 | 745 | data->control_unit_queuing_time |
94bb0633 | 746 | = time_to_nsec(cmb->control_unit_queuing_time); |
1da177e4 | 747 | data->device_active_only_time |
94bb0633 CH |
748 | = time_to_nsec(cmb->device_active_only_time); |
749 | ret = 0; | |
750 | out: | |
751 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
752 | return ret; | |
753 | } | |
1da177e4 | 754 | |
94bb0633 CH |
755 | static void reset_cmb(struct ccw_device *cdev) |
756 | { | |
757 | cmf_generic_reset(cdev); | |
1da177e4 LT |
758 | } |
759 | ||
94bb0633 | 760 | static void * align_cmb(void *area) |
1da177e4 | 761 | { |
94bb0633 | 762 | return area; |
1da177e4 LT |
763 | } |
764 | ||
765 | static struct attribute_group cmf_attr_group; | |
766 | ||
767 | static struct cmb_operations cmbops_basic = { | |
768 | .alloc = alloc_cmb, | |
769 | .free = free_cmb, | |
770 | .set = set_cmb, | |
771 | .read = read_cmb, | |
772 | .readall = readall_cmb, | |
773 | .reset = reset_cmb, | |
94bb0633 | 774 | .align = align_cmb, |
1da177e4 LT |
775 | .attr_group = &cmf_attr_group, |
776 | }; | |
364c8558 | 777 | |
1da177e4 LT |
778 | /* ******** extended cmb handling ********/ |
779 | ||
780 | /** | |
781 | * struct cmbe - extended channel measurement block | |
c0208716 CH |
782 | * @ssch_rsch_count: number of ssch and rsch |
783 | * @sample_count: number of samples | |
784 | * @device_connect_time: time of device connect | |
785 | * @function_pending_time: time of function pending | |
786 | * @device_disconnect_time: time of device disconnect | |
787 | * @control_unit_queuing_time: time of control unit queuing | |
788 | * @device_active_only_time: time of device active only | |
789 | * @device_busy_time: time of device busy | |
790 | * @initial_command_response_time: initial command response time | |
791 | * @reserved: unused | |
1da177e4 | 792 | * |
c0208716 CH |
793 | * The measurement block as used by the hardware. May be in any 64 bit physical |
794 | * location. | |
795 | * The fields are described further in z/Architecture Principles of Operation, | |
1da177e4 LT |
796 | * third edition, chapter 17. |
797 | */ | |
798 | struct cmbe { | |
799 | u32 ssch_rsch_count; | |
800 | u32 sample_count; | |
801 | u32 device_connect_time; | |
802 | u32 function_pending_time; | |
803 | u32 device_disconnect_time; | |
804 | u32 control_unit_queuing_time; | |
805 | u32 device_active_only_time; | |
806 | u32 device_busy_time; | |
807 | u32 initial_command_response_time; | |
808 | u32 reserved[7]; | |
809 | }; | |
810 | ||
fc5019c5 CH |
811 | /* |
812 | * kmalloc only guarantees 8 byte alignment, but we need cmbe | |
1da177e4 | 813 | * pointers to be naturally aligned. Make sure to allocate |
fc5019c5 CH |
814 | * enough space for two cmbes. |
815 | */ | |
816 | static inline struct cmbe *cmbe_align(struct cmbe *c) | |
1da177e4 LT |
817 | { |
818 | unsigned long addr; | |
819 | addr = ((unsigned long)c + sizeof (struct cmbe) - sizeof(long)) & | |
820 | ~(sizeof (struct cmbe) - sizeof(long)); | |
821 | return (struct cmbe*)addr; | |
822 | } | |
823 | ||
fc5019c5 | 824 | static int alloc_cmbe(struct ccw_device *cdev) |
1da177e4 LT |
825 | { |
826 | struct cmbe *cmbe; | |
94bb0633 CH |
827 | struct cmb_data *cmb_data; |
828 | int ret; | |
829 | ||
830 | cmbe = kzalloc (sizeof (*cmbe) * 2, GFP_KERNEL); | |
1da177e4 LT |
831 | if (!cmbe) |
832 | return -ENOMEM; | |
94bb0633 CH |
833 | cmb_data = kzalloc(sizeof(struct cmb_data), GFP_KERNEL); |
834 | if (!cmb_data) { | |
835 | ret = -ENOMEM; | |
836 | goto out_free; | |
837 | } | |
838 | cmb_data->last_block = kzalloc(sizeof(struct cmbe), GFP_KERNEL); | |
839 | if (!cmb_data->last_block) { | |
840 | ret = -ENOMEM; | |
841 | goto out_free; | |
842 | } | |
843 | cmb_data->size = sizeof(struct cmbe); | |
1da177e4 LT |
844 | spin_lock_irq(cdev->ccwlock); |
845 | if (cdev->private->cmb) { | |
1da177e4 | 846 | spin_unlock_irq(cdev->ccwlock); |
94bb0633 CH |
847 | ret = -EBUSY; |
848 | goto out_free; | |
1da177e4 | 849 | } |
94bb0633 CH |
850 | cmb_data->hw_block = cmbe; |
851 | cdev->private->cmb = cmb_data; | |
1da177e4 LT |
852 | spin_unlock_irq(cdev->ccwlock); |
853 | ||
854 | /* activate global measurement if this is the first channel */ | |
855 | spin_lock(&cmb_area.lock); | |
856 | if (list_empty(&cmb_area.list)) | |
857 | cmf_activate(NULL, 1); | |
858 | list_add_tail(&cdev->private->cmb_list, &cmb_area.list); | |
859 | spin_unlock(&cmb_area.lock); | |
860 | ||
861 | return 0; | |
94bb0633 CH |
862 | out_free: |
863 | if (cmb_data) | |
864 | kfree(cmb_data->last_block); | |
865 | kfree(cmb_data); | |
866 | kfree(cmbe); | |
867 | return ret; | |
1da177e4 LT |
868 | } |
869 | ||
fc5019c5 | 870 | static void free_cmbe(struct ccw_device *cdev) |
1da177e4 | 871 | { |
94bb0633 CH |
872 | struct cmb_data *cmb_data; |
873 | ||
1da177e4 | 874 | spin_lock_irq(cdev->ccwlock); |
94bb0633 | 875 | cmb_data = cdev->private->cmb; |
1da177e4 | 876 | cdev->private->cmb = NULL; |
94bb0633 CH |
877 | if (cmb_data) |
878 | kfree(cmb_data->last_block); | |
879 | kfree(cmb_data); | |
1da177e4 LT |
880 | spin_unlock_irq(cdev->ccwlock); |
881 | ||
882 | /* deactivate global measurement if this is the last channel */ | |
883 | spin_lock(&cmb_area.lock); | |
884 | list_del_init(&cdev->private->cmb_list); | |
885 | if (list_empty(&cmb_area.list)) | |
886 | cmf_activate(NULL, 0); | |
887 | spin_unlock(&cmb_area.lock); | |
888 | } | |
889 | ||
94bb0633 | 890 | static int set_cmbe(struct ccw_device *cdev, u32 mme) |
1da177e4 LT |
891 | { |
892 | unsigned long mba; | |
94bb0633 CH |
893 | struct cmb_data *cmb_data; |
894 | unsigned long flags; | |
1da177e4 | 895 | |
94bb0633 CH |
896 | spin_lock_irqsave(cdev->ccwlock, flags); |
897 | if (!cdev->private->cmb) { | |
898 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
1da177e4 | 899 | return -EINVAL; |
94bb0633 CH |
900 | } |
901 | cmb_data = cdev->private->cmb; | |
902 | mba = mme ? (unsigned long) cmbe_align(cmb_data->hw_block) : 0; | |
903 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
1da177e4 LT |
904 | |
905 | return set_schib_wait(cdev, mme, 1, mba); | |
906 | } | |
907 | ||
908 | ||
fc5019c5 | 909 | static u64 read_cmbe(struct ccw_device *cdev, int index) |
1da177e4 | 910 | { |
94bb0633 CH |
911 | struct cmbe *cmb; |
912 | struct cmb_data *cmb_data; | |
1da177e4 | 913 | u32 val; |
94bb0633 CH |
914 | int ret; |
915 | unsigned long flags; | |
1da177e4 | 916 | |
94bb0633 CH |
917 | ret = cmf_cmb_copy_wait(cdev); |
918 | if (ret < 0) | |
1da177e4 | 919 | return 0; |
1da177e4 | 920 | |
94bb0633 CH |
921 | spin_lock_irqsave(cdev->ccwlock, flags); |
922 | cmb_data = cdev->private->cmb; | |
923 | if (!cmb_data) { | |
924 | ret = 0; | |
925 | goto out; | |
926 | } | |
927 | cmb = cmb_data->last_block; | |
1da177e4 LT |
928 | |
929 | switch (index) { | |
930 | case cmb_ssch_rsch_count: | |
94bb0633 CH |
931 | ret = cmb->ssch_rsch_count; |
932 | goto out; | |
1da177e4 | 933 | case cmb_sample_count: |
94bb0633 CH |
934 | ret = cmb->sample_count; |
935 | goto out; | |
1da177e4 | 936 | case cmb_device_connect_time: |
94bb0633 | 937 | val = cmb->device_connect_time; |
1da177e4 LT |
938 | break; |
939 | case cmb_function_pending_time: | |
94bb0633 | 940 | val = cmb->function_pending_time; |
1da177e4 LT |
941 | break; |
942 | case cmb_device_disconnect_time: | |
94bb0633 | 943 | val = cmb->device_disconnect_time; |
1da177e4 LT |
944 | break; |
945 | case cmb_control_unit_queuing_time: | |
94bb0633 | 946 | val = cmb->control_unit_queuing_time; |
1da177e4 LT |
947 | break; |
948 | case cmb_device_active_only_time: | |
94bb0633 | 949 | val = cmb->device_active_only_time; |
1da177e4 LT |
950 | break; |
951 | case cmb_device_busy_time: | |
94bb0633 | 952 | val = cmb->device_busy_time; |
1da177e4 LT |
953 | break; |
954 | case cmb_initial_command_response_time: | |
94bb0633 | 955 | val = cmb->initial_command_response_time; |
1da177e4 LT |
956 | break; |
957 | default: | |
94bb0633 CH |
958 | ret = 0; |
959 | goto out; | |
1da177e4 | 960 | } |
94bb0633 CH |
961 | ret = time_to_avg_nsec(val, cmb->sample_count); |
962 | out: | |
963 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
964 | return ret; | |
1da177e4 LT |
965 | } |
966 | ||
fc5019c5 | 967 | static int readall_cmbe(struct ccw_device *cdev, struct cmbdata *data) |
1da177e4 | 968 | { |
94bb0633 CH |
969 | struct cmbe *cmb; |
970 | struct cmb_data *cmb_data; | |
1da177e4 | 971 | u64 time; |
94bb0633 CH |
972 | unsigned long flags; |
973 | int ret; | |
1da177e4 | 974 | |
94bb0633 CH |
975 | ret = cmf_cmb_copy_wait(cdev); |
976 | if (ret < 0) | |
977 | return ret; | |
1da177e4 | 978 | spin_lock_irqsave(cdev->ccwlock, flags); |
94bb0633 CH |
979 | cmb_data = cdev->private->cmb; |
980 | if (!cmb_data) { | |
981 | ret = -ENODEV; | |
982 | goto out; | |
1da177e4 | 983 | } |
94bb0633 CH |
984 | if (cmb_data->last_update == 0) { |
985 | ret = -EAGAIN; | |
986 | goto out; | |
987 | } | |
988 | time = cmb_data->last_update - cdev->private->cmb_start_time; | |
1da177e4 LT |
989 | |
990 | memset (data, 0, sizeof(struct cmbdata)); | |
991 | ||
992 | /* we only know values before device_busy_time */ | |
993 | data->size = offsetof(struct cmbdata, device_busy_time); | |
994 | ||
995 | /* conver to nanoseconds */ | |
996 | data->elapsed_time = (time * 1000) >> 12; | |
997 | ||
94bb0633 | 998 | cmb = cmb_data->last_block; |
1da177e4 | 999 | /* copy data to new structure */ |
94bb0633 CH |
1000 | data->ssch_rsch_count = cmb->ssch_rsch_count; |
1001 | data->sample_count = cmb->sample_count; | |
1da177e4 LT |
1002 | |
1003 | /* time fields are converted to nanoseconds while copying */ | |
94bb0633 CH |
1004 | data->device_connect_time = time_to_nsec(cmb->device_connect_time); |
1005 | data->function_pending_time = time_to_nsec(cmb->function_pending_time); | |
1006 | data->device_disconnect_time = | |
1007 | time_to_nsec(cmb->device_disconnect_time); | |
1da177e4 | 1008 | data->control_unit_queuing_time |
94bb0633 | 1009 | = time_to_nsec(cmb->control_unit_queuing_time); |
1da177e4 | 1010 | data->device_active_only_time |
94bb0633 CH |
1011 | = time_to_nsec(cmb->device_active_only_time); |
1012 | data->device_busy_time = time_to_nsec(cmb->device_busy_time); | |
1da177e4 | 1013 | data->initial_command_response_time |
94bb0633 | 1014 | = time_to_nsec(cmb->initial_command_response_time); |
1da177e4 | 1015 | |
94bb0633 CH |
1016 | ret = 0; |
1017 | out: | |
1018 | spin_unlock_irqrestore(cdev->ccwlock, flags); | |
1019 | return ret; | |
1da177e4 LT |
1020 | } |
1021 | ||
94bb0633 | 1022 | static void reset_cmbe(struct ccw_device *cdev) |
1da177e4 | 1023 | { |
94bb0633 CH |
1024 | cmf_generic_reset(cdev); |
1025 | } | |
1026 | ||
1027 | static void * align_cmbe(void *area) | |
1028 | { | |
1029 | return cmbe_align(area); | |
1da177e4 LT |
1030 | } |
1031 | ||
1032 | static struct attribute_group cmf_attr_group_ext; | |
1033 | ||
1034 | static struct cmb_operations cmbops_extended = { | |
1035 | .alloc = alloc_cmbe, | |
1036 | .free = free_cmbe, | |
1037 | .set = set_cmbe, | |
1038 | .read = read_cmbe, | |
1039 | .readall = readall_cmbe, | |
1040 | .reset = reset_cmbe, | |
94bb0633 | 1041 | .align = align_cmbe, |
1da177e4 LT |
1042 | .attr_group = &cmf_attr_group_ext, |
1043 | }; | |
1da177e4 | 1044 | |
fc5019c5 | 1045 | static ssize_t cmb_show_attr(struct device *dev, char *buf, enum cmb_index idx) |
1da177e4 LT |
1046 | { |
1047 | return sprintf(buf, "%lld\n", | |
1048 | (unsigned long long) cmf_read(to_ccwdev(dev), idx)); | |
1049 | } | |
1050 | ||
fc5019c5 CH |
1051 | static ssize_t cmb_show_avg_sample_interval(struct device *dev, |
1052 | struct device_attribute *attr, | |
1053 | char *buf) | |
1da177e4 LT |
1054 | { |
1055 | struct ccw_device *cdev; | |
1056 | long interval; | |
1057 | unsigned long count; | |
94bb0633 | 1058 | struct cmb_data *cmb_data; |
1da177e4 LT |
1059 | |
1060 | cdev = to_ccwdev(dev); | |
1da177e4 | 1061 | count = cmf_read(cdev, cmb_sample_count); |
94bb0633 CH |
1062 | spin_lock_irq(cdev->ccwlock); |
1063 | cmb_data = cdev->private->cmb; | |
1064 | if (count) { | |
1065 | interval = cmb_data->last_update - | |
1066 | cdev->private->cmb_start_time; | |
13ffa927 | 1067 | interval = (interval * 1000) >> 12; |
1da177e4 | 1068 | interval /= count; |
94bb0633 | 1069 | } else |
1da177e4 | 1070 | interval = -1; |
94bb0633 | 1071 | spin_unlock_irq(cdev->ccwlock); |
1da177e4 LT |
1072 | return sprintf(buf, "%ld\n", interval); |
1073 | } | |
1074 | ||
fc5019c5 CH |
1075 | static ssize_t cmb_show_avg_utilization(struct device *dev, |
1076 | struct device_attribute *attr, | |
1077 | char *buf) | |
1da177e4 LT |
1078 | { |
1079 | struct cmbdata data; | |
1080 | u64 utilization; | |
1081 | unsigned long t, u; | |
1082 | int ret; | |
1083 | ||
1084 | ret = cmf_readall(to_ccwdev(dev), &data); | |
94bb0633 CH |
1085 | if (ret == -EAGAIN || ret == -ENODEV) |
1086 | /* No data (yet/currently) available to use for calculation. */ | |
1087 | return sprintf(buf, "n/a\n"); | |
1088 | else if (ret) | |
1da177e4 LT |
1089 | return ret; |
1090 | ||
1091 | utilization = data.device_connect_time + | |
1092 | data.function_pending_time + | |
1093 | data.device_disconnect_time; | |
1094 | ||
1095 | /* shift to avoid long long division */ | |
1096 | while (-1ul < (data.elapsed_time | utilization)) { | |
1097 | utilization >>= 8; | |
1098 | data.elapsed_time >>= 8; | |
1099 | } | |
1100 | ||
1101 | /* calculate value in 0.1 percent units */ | |
1102 | t = (unsigned long) data.elapsed_time / 1000; | |
1103 | u = (unsigned long) utilization / t; | |
1104 | ||
1105 | return sprintf(buf, "%02ld.%01ld%%\n", u/ 10, u - (u/ 10) * 10); | |
1106 | } | |
1107 | ||
1108 | #define cmf_attr(name) \ | |
fc5019c5 CH |
1109 | static ssize_t show_##name(struct device *dev, \ |
1110 | struct device_attribute *attr, char *buf) \ | |
1111 | { return cmb_show_attr((dev), buf, cmb_##name); } \ | |
1112 | static DEVICE_ATTR(name, 0444, show_##name, NULL); | |
1da177e4 LT |
1113 | |
1114 | #define cmf_attr_avg(name) \ | |
fc5019c5 CH |
1115 | static ssize_t show_avg_##name(struct device *dev, \ |
1116 | struct device_attribute *attr, char *buf) \ | |
1117 | { return cmb_show_attr((dev), buf, cmb_##name); } \ | |
1118 | static DEVICE_ATTR(avg_##name, 0444, show_avg_##name, NULL); | |
1da177e4 LT |
1119 | |
1120 | cmf_attr(ssch_rsch_count); | |
1121 | cmf_attr(sample_count); | |
1122 | cmf_attr_avg(device_connect_time); | |
1123 | cmf_attr_avg(function_pending_time); | |
1124 | cmf_attr_avg(device_disconnect_time); | |
1125 | cmf_attr_avg(control_unit_queuing_time); | |
1126 | cmf_attr_avg(device_active_only_time); | |
1127 | cmf_attr_avg(device_busy_time); | |
1128 | cmf_attr_avg(initial_command_response_time); | |
1129 | ||
fc5019c5 CH |
1130 | static DEVICE_ATTR(avg_sample_interval, 0444, cmb_show_avg_sample_interval, |
1131 | NULL); | |
1da177e4 LT |
1132 | static DEVICE_ATTR(avg_utilization, 0444, cmb_show_avg_utilization, NULL); |
1133 | ||
1134 | static struct attribute *cmf_attributes[] = { | |
1135 | &dev_attr_avg_sample_interval.attr, | |
1136 | &dev_attr_avg_utilization.attr, | |
1137 | &dev_attr_ssch_rsch_count.attr, | |
1138 | &dev_attr_sample_count.attr, | |
1139 | &dev_attr_avg_device_connect_time.attr, | |
1140 | &dev_attr_avg_function_pending_time.attr, | |
1141 | &dev_attr_avg_device_disconnect_time.attr, | |
1142 | &dev_attr_avg_control_unit_queuing_time.attr, | |
1143 | &dev_attr_avg_device_active_only_time.attr, | |
d2c993d8 | 1144 | NULL, |
1da177e4 LT |
1145 | }; |
1146 | ||
1147 | static struct attribute_group cmf_attr_group = { | |
1148 | .name = "cmf", | |
1149 | .attrs = cmf_attributes, | |
1150 | }; | |
1151 | ||
1152 | static struct attribute *cmf_attributes_ext[] = { | |
1153 | &dev_attr_avg_sample_interval.attr, | |
1154 | &dev_attr_avg_utilization.attr, | |
1155 | &dev_attr_ssch_rsch_count.attr, | |
1156 | &dev_attr_sample_count.attr, | |
1157 | &dev_attr_avg_device_connect_time.attr, | |
1158 | &dev_attr_avg_function_pending_time.attr, | |
1159 | &dev_attr_avg_device_disconnect_time.attr, | |
1160 | &dev_attr_avg_control_unit_queuing_time.attr, | |
1161 | &dev_attr_avg_device_active_only_time.attr, | |
1162 | &dev_attr_avg_device_busy_time.attr, | |
1163 | &dev_attr_avg_initial_command_response_time.attr, | |
d2c993d8 | 1164 | NULL, |
1da177e4 LT |
1165 | }; |
1166 | ||
1167 | static struct attribute_group cmf_attr_group_ext = { | |
1168 | .name = "cmf", | |
1169 | .attrs = cmf_attributes_ext, | |
1170 | }; | |
1171 | ||
fc5019c5 CH |
1172 | static ssize_t cmb_enable_show(struct device *dev, |
1173 | struct device_attribute *attr, | |
1174 | char *buf) | |
1da177e4 LT |
1175 | { |
1176 | return sprintf(buf, "%d\n", to_ccwdev(dev)->private->cmb ? 1 : 0); | |
1177 | } | |
1178 | ||
fc5019c5 CH |
1179 | static ssize_t cmb_enable_store(struct device *dev, |
1180 | struct device_attribute *attr, const char *buf, | |
1181 | size_t c) | |
1da177e4 LT |
1182 | { |
1183 | struct ccw_device *cdev; | |
1184 | int ret; | |
2f972202 CH |
1185 | unsigned long val; |
1186 | ||
1187 | ret = strict_strtoul(buf, 16, &val); | |
1188 | if (ret) | |
1189 | return ret; | |
1da177e4 LT |
1190 | |
1191 | cdev = to_ccwdev(dev); | |
1192 | ||
2f972202 CH |
1193 | switch (val) { |
1194 | case 0: | |
1da177e4 | 1195 | ret = disable_cmf(cdev); |
1da177e4 | 1196 | break; |
2f972202 | 1197 | case 1: |
1da177e4 | 1198 | ret = enable_cmf(cdev); |
1da177e4 LT |
1199 | break; |
1200 | } | |
1201 | ||
1202 | return c; | |
1203 | } | |
1204 | ||
1205 | DEVICE_ATTR(cmb_enable, 0644, cmb_enable_show, cmb_enable_store); | |
1206 | ||
c0208716 CH |
1207 | /** |
1208 | * enable_cmf() - switch on the channel measurement for a specific device | |
1209 | * @cdev: The ccw device to be enabled | |
1210 | * | |
1211 | * Returns %0 for success or a negative error value. | |
1212 | * | |
1213 | * Context: | |
1214 | * non-atomic | |
1215 | */ | |
fc5019c5 | 1216 | int enable_cmf(struct ccw_device *cdev) |
1da177e4 LT |
1217 | { |
1218 | int ret; | |
1219 | ||
1220 | ret = cmbops->alloc(cdev); | |
1221 | cmbops->reset(cdev); | |
1222 | if (ret) | |
1223 | return ret; | |
1224 | ret = cmbops->set(cdev, 2); | |
1225 | if (ret) { | |
1226 | cmbops->free(cdev); | |
1227 | return ret; | |
1228 | } | |
1229 | ret = sysfs_create_group(&cdev->dev.kobj, cmbops->attr_group); | |
1230 | if (!ret) | |
1231 | return 0; | |
1232 | cmbops->set(cdev, 0); //FIXME: this can fail | |
1233 | cmbops->free(cdev); | |
1234 | return ret; | |
1235 | } | |
1236 | ||
c0208716 CH |
1237 | /** |
1238 | * disable_cmf() - switch off the channel measurement for a specific device | |
1239 | * @cdev: The ccw device to be disabled | |
1240 | * | |
1241 | * Returns %0 for success or a negative error value. | |
1242 | * | |
1243 | * Context: | |
1244 | * non-atomic | |
1245 | */ | |
fc5019c5 | 1246 | int disable_cmf(struct ccw_device *cdev) |
1da177e4 LT |
1247 | { |
1248 | int ret; | |
1249 | ||
1250 | ret = cmbops->set(cdev, 0); | |
1251 | if (ret) | |
1252 | return ret; | |
1253 | cmbops->free(cdev); | |
1254 | sysfs_remove_group(&cdev->dev.kobj, cmbops->attr_group); | |
1255 | return ret; | |
1256 | } | |
1257 | ||
c0208716 CH |
1258 | /** |
1259 | * cmf_read() - read one value from the current channel measurement block | |
1260 | * @cdev: the channel to be read | |
1261 | * @index: the index of the value to be read | |
1262 | * | |
1263 | * Returns the value read or %0 if the value cannot be read. | |
1264 | * | |
1265 | * Context: | |
1266 | * any | |
1267 | */ | |
fc5019c5 | 1268 | u64 cmf_read(struct ccw_device *cdev, int index) |
1da177e4 LT |
1269 | { |
1270 | return cmbops->read(cdev, index); | |
1271 | } | |
1272 | ||
c0208716 CH |
1273 | /** |
1274 | * cmf_readall() - read the current channel measurement block | |
1275 | * @cdev: the channel to be read | |
1276 | * @data: a pointer to a data block that will be filled | |
1277 | * | |
1278 | * Returns %0 on success, a negative error value otherwise. | |
1279 | * | |
1280 | * Context: | |
1281 | * any | |
1282 | */ | |
fc5019c5 | 1283 | int cmf_readall(struct ccw_device *cdev, struct cmbdata *data) |
1da177e4 LT |
1284 | { |
1285 | return cmbops->readall(cdev, data); | |
1286 | } | |
1287 | ||
94bb0633 CH |
1288 | /* Reenable cmf when a disconnected device becomes available again. */ |
1289 | int cmf_reenable(struct ccw_device *cdev) | |
1290 | { | |
1291 | cmbops->reset(cdev); | |
1292 | return cmbops->set(cdev, 2); | |
1293 | } | |
1294 | ||
fc5019c5 | 1295 | static int __init init_cmf(void) |
1da177e4 LT |
1296 | { |
1297 | char *format_string; | |
1298 | char *detect_string = "parameter"; | |
1299 | ||
fc5019c5 CH |
1300 | /* |
1301 | * If the user did not give a parameter, see if we are running on a | |
1302 | * machine supporting extended measurement blocks, otherwise fall back | |
1303 | * to basic mode. | |
1304 | */ | |
1da177e4 | 1305 | if (format == CMF_AUTODETECT) { |
75784c00 | 1306 | if (!css_general_characteristics.ext_mb) { |
1da177e4 LT |
1307 | format = CMF_BASIC; |
1308 | } else { | |
1309 | format = CMF_EXTENDED; | |
1310 | } | |
1311 | detect_string = "autodetected"; | |
1312 | } else { | |
1313 | detect_string = "parameter"; | |
1314 | } | |
1315 | ||
1316 | switch (format) { | |
1317 | case CMF_BASIC: | |
1318 | format_string = "basic"; | |
1319 | cmbops = &cmbops_basic; | |
1da177e4 LT |
1320 | break; |
1321 | case CMF_EXTENDED: | |
fc5019c5 | 1322 | format_string = "extended"; |
1da177e4 LT |
1323 | cmbops = &cmbops_extended; |
1324 | break; | |
1325 | default: | |
1da177e4 LT |
1326 | return 1; |
1327 | } | |
e6d5a428 ME |
1328 | pr_info("Channel measurement facility initialized using format " |
1329 | "%s (mode %s)\n", format_string, detect_string); | |
1da177e4 LT |
1330 | return 0; |
1331 | } | |
1332 | ||
1333 | module_init(init_cmf); | |
1334 | ||
1335 | ||
1336 | MODULE_AUTHOR("Arnd Bergmann <arndb@de.ibm.com>"); | |
1337 | MODULE_LICENSE("GPL"); | |
1338 | MODULE_DESCRIPTION("channel measurement facility base driver\n" | |
1339 | "Copyright 2003 IBM Corporation\n"); | |
1340 | ||
1341 | EXPORT_SYMBOL_GPL(enable_cmf); | |
1342 | EXPORT_SYMBOL_GPL(disable_cmf); | |
1343 | EXPORT_SYMBOL_GPL(cmf_read); | |
1344 | EXPORT_SYMBOL_GPL(cmf_readall); |