Blame view

drivers/scsi/ses.c 17.5 KB
9927c6886   James Bottomley   [SCSI] ses: add n...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
  /*
   * SCSI Enclosure Services
   *
   * Copyright (C) 2008 James Bottomley <James.Bottomley@HansenPartnership.com>
   *
  **-----------------------------------------------------------------------------
  **
  **  This program is free software; you can redistribute it and/or
  **  modify it under the terms of the GNU General Public License
  **  version 2 as published by the Free Software Foundation.
  **
  **  This program is distributed in the hope that it will be useful,
  **  but WITHOUT ANY WARRANTY; without even the implied warranty of
  **  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  **  GNU General Public License for more details.
  **
  **  You should have received a copy of the GNU General Public License
  **  along with this program; if not, write to the Free Software
  **  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  **
  **-----------------------------------------------------------------------------
  */
5a0e3ad6a   Tejun Heo   include cleanup: ...
23
  #include <linux/slab.h>
9927c6886   James Bottomley   [SCSI] ses: add n...
24
25
26
27
28
29
30
31
32
33
34
35
  #include <linux/module.h>
  #include <linux/kernel.h>
  #include <linux/enclosure.h>
  
  #include <scsi/scsi.h>
  #include <scsi/scsi_cmnd.h>
  #include <scsi/scsi_dbg.h>
  #include <scsi/scsi_device.h>
  #include <scsi/scsi_driver.h>
  #include <scsi/scsi_host.h>
  
  struct ses_device {
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
36
  	unsigned char *page1;
8c3adc796   James Bottomley   [SCSI] ses: add s...
37
  	unsigned char *page1_types;
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
38
39
  	unsigned char *page2;
  	unsigned char *page10;
9927c6886   James Bottomley   [SCSI] ses: add n...
40
  	short page1_len;
8c3adc796   James Bottomley   [SCSI] ses: add s...
41
  	short page1_num_types;
9927c6886   James Bottomley   [SCSI] ses: add n...
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
  	short page2_len;
  	short page10_len;
  };
  
  struct ses_component {
  	u64 addr;
  	unsigned char *desc;
  };
  
  static int ses_probe(struct device *dev)
  {
  	struct scsi_device *sdev = to_scsi_device(dev);
  	int err = -ENODEV;
  
  	if (sdev->type != TYPE_ENCLOSURE)
  		goto out;
  
  	err = 0;
  	sdev_printk(KERN_NOTICE, sdev, "Attached Enclosure device
  ");
  
   out:
  	return err;
  }
c95e62ce8   Matthew Wilcox   [SCSI] ses: Fix t...
66
  #define SES_TIMEOUT (30 * HZ)
9927c6886   James Bottomley   [SCSI] ses: add n...
67
68
69
70
71
  #define SES_RETRIES 3
  
  static int ses_recv_diag(struct scsi_device *sdev, int page_code,
  			 void *buf, int bufflen)
  {
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
72
  	unsigned char cmd[] = {
9927c6886   James Bottomley   [SCSI] ses: add n...
73
74
75
76
77
78
79
80
81
  		RECEIVE_DIAGNOSTIC,
  		1,		/* Set PCV bit */
  		page_code,
  		bufflen >> 8,
  		bufflen & 0xff,
  		0
  	};
  
  	return scsi_execute_req(sdev, cmd, DMA_FROM_DEVICE, buf, bufflen,
f4f4e47e4   FUJITA Tomonori   [SCSI] add residu...
82
  				NULL, SES_TIMEOUT, SES_RETRIES, NULL);
9927c6886   James Bottomley   [SCSI] ses: add n...
83
84
85
86
87
88
  }
  
  static int ses_send_diag(struct scsi_device *sdev, int page_code,
  			 void *buf, int bufflen)
  {
  	u32 result;
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
89
  	unsigned char cmd[] = {
9927c6886   James Bottomley   [SCSI] ses: add n...
90
91
92
93
94
95
96
97
98
  		SEND_DIAGNOSTIC,
  		0x10,		/* Set PF bit */
  		0,
  		bufflen >> 8,
  		bufflen & 0xff,
  		0
  	};
  
  	result = scsi_execute_req(sdev, cmd, DMA_TO_DEVICE, buf, bufflen,
f4f4e47e4   FUJITA Tomonori   [SCSI] add residu...
99
  				  NULL, SES_TIMEOUT, SES_RETRIES, NULL);
9927c6886   James Bottomley   [SCSI] ses: add n...
100
101
102
103
104
105
106
107
108
  	if (result)
  		sdev_printk(KERN_ERR, sdev, "SEND DIAGNOSTIC result: %8x
  ",
  			    result);
  	return result;
  }
  
  static int ses_set_page2_descriptor(struct enclosure_device *edev,
  				      struct enclosure_component *ecomp,
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
109
  				      unsigned char *desc)
9927c6886   James Bottomley   [SCSI] ses: add n...
110
111
  {
  	int i, j, count = 0, descriptor = ecomp->number;
ee959b00c   Tony Jones   SCSI: convert str...
112
  	struct scsi_device *sdev = to_scsi_device(edev->edev.parent);
9927c6886   James Bottomley   [SCSI] ses: add n...
113
  	struct ses_device *ses_dev = edev->scratch;
8c3adc796   James Bottomley   [SCSI] ses: add s...
114
  	unsigned char *type_ptr = ses_dev->page1_types;
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
115
  	unsigned char *desc_ptr = ses_dev->page2 + 8;
9927c6886   James Bottomley   [SCSI] ses: add n...
116
117
118
  
  	/* Clear everything */
  	memset(desc_ptr, 0, ses_dev->page2_len - 8);
8c3adc796   James Bottomley   [SCSI] ses: add s...
119
  	for (i = 0; i < ses_dev->page1_num_types; i++, type_ptr += 4) {
9927c6886   James Bottomley   [SCSI] ses: add n...
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
  		for (j = 0; j < type_ptr[1]; j++) {
  			desc_ptr += 4;
  			if (type_ptr[0] != ENCLOSURE_COMPONENT_DEVICE &&
  			    type_ptr[0] != ENCLOSURE_COMPONENT_ARRAY_DEVICE)
  				continue;
  			if (count++ == descriptor) {
  				memcpy(desc_ptr, desc, 4);
  				/* set select */
  				desc_ptr[0] |= 0x80;
  				/* clear reserved, just in case */
  				desc_ptr[0] &= 0xf0;
  			}
  		}
  	}
  
  	return ses_send_diag(sdev, 2, ses_dev->page2, ses_dev->page2_len);
  }
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
137
  static unsigned char *ses_get_page2_descriptor(struct enclosure_device *edev,
9927c6886   James Bottomley   [SCSI] ses: add n...
138
139
140
  				      struct enclosure_component *ecomp)
  {
  	int i, j, count = 0, descriptor = ecomp->number;
ee959b00c   Tony Jones   SCSI: convert str...
141
  	struct scsi_device *sdev = to_scsi_device(edev->edev.parent);
9927c6886   James Bottomley   [SCSI] ses: add n...
142
  	struct ses_device *ses_dev = edev->scratch;
8c3adc796   James Bottomley   [SCSI] ses: add s...
143
  	unsigned char *type_ptr = ses_dev->page1_types;
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
144
  	unsigned char *desc_ptr = ses_dev->page2 + 8;
9927c6886   James Bottomley   [SCSI] ses: add n...
145
146
  
  	ses_recv_diag(sdev, 2, ses_dev->page2, ses_dev->page2_len);
8c3adc796   James Bottomley   [SCSI] ses: add s...
147
  	for (i = 0; i < ses_dev->page1_num_types; i++, type_ptr += 4) {
9927c6886   James Bottomley   [SCSI] ses: add n...
148
149
150
151
152
153
154
155
156
157
158
  		for (j = 0; j < type_ptr[1]; j++) {
  			desc_ptr += 4;
  			if (type_ptr[0] != ENCLOSURE_COMPONENT_DEVICE &&
  			    type_ptr[0] != ENCLOSURE_COMPONENT_ARRAY_DEVICE)
  				continue;
  			if (count++ == descriptor)
  				return desc_ptr;
  		}
  	}
  	return NULL;
  }
2a350cab9   Douglas Gilbert   [SCSI] ses: reque...
159
160
161
162
  /* For device slot and array device slot elements, byte 3 bit 6
   * is "fault sensed" while byte 3 bit 5 is "fault reqstd". As this
   * code stands these bits are shifted 4 positions right so in
   * sysfs they will appear as bits 2 and 1 respectively. Strange. */
9927c6886   James Bottomley   [SCSI] ses: add n...
163
164
165
  static void ses_get_fault(struct enclosure_device *edev,
  			  struct enclosure_component *ecomp)
  {
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
166
  	unsigned char *desc;
9927c6886   James Bottomley   [SCSI] ses: add n...
167
168
  
  	desc = ses_get_page2_descriptor(edev, ecomp);
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
169
170
  	if (desc)
  		ecomp->fault = (desc[3] & 0x60) >> 4;
9927c6886   James Bottomley   [SCSI] ses: add n...
171
172
173
174
175
176
  }
  
  static int ses_set_fault(struct enclosure_device *edev,
  			  struct enclosure_component *ecomp,
  			 enum enclosure_component_setting val)
  {
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
177
  	unsigned char desc[4] = {0 };
9927c6886   James Bottomley   [SCSI] ses: add n...
178
179
180
181
182
183
  
  	switch (val) {
  	case ENCLOSURE_SETTING_DISABLED:
  		/* zero is disabled */
  		break;
  	case ENCLOSURE_SETTING_ENABLED:
2a350cab9   Douglas Gilbert   [SCSI] ses: reque...
184
  		desc[3] = 0x20;
9927c6886   James Bottomley   [SCSI] ses: add n...
185
186
187
188
189
190
191
192
193
194
195
196
  		break;
  	default:
  		/* SES doesn't do the SGPIO blink settings */
  		return -EINVAL;
  	}
  
  	return ses_set_page2_descriptor(edev, ecomp, desc);
  }
  
  static void ses_get_status(struct enclosure_device *edev,
  			   struct enclosure_component *ecomp)
  {
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
197
  	unsigned char *desc;
9927c6886   James Bottomley   [SCSI] ses: add n...
198
199
  
  	desc = ses_get_page2_descriptor(edev, ecomp);
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
200
201
  	if (desc)
  		ecomp->status = (desc[0] & 0x0f);
9927c6886   James Bottomley   [SCSI] ses: add n...
202
203
204
205
206
  }
  
  static void ses_get_locate(struct enclosure_device *edev,
  			   struct enclosure_component *ecomp)
  {
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
207
  	unsigned char *desc;
9927c6886   James Bottomley   [SCSI] ses: add n...
208
209
  
  	desc = ses_get_page2_descriptor(edev, ecomp);
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
210
211
  	if (desc)
  		ecomp->locate = (desc[2] & 0x02) ? 1 : 0;
9927c6886   James Bottomley   [SCSI] ses: add n...
212
213
214
215
216
217
  }
  
  static int ses_set_locate(struct enclosure_device *edev,
  			  struct enclosure_component *ecomp,
  			  enum enclosure_component_setting val)
  {
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
218
  	unsigned char desc[4] = {0 };
9927c6886   James Bottomley   [SCSI] ses: add n...
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
  
  	switch (val) {
  	case ENCLOSURE_SETTING_DISABLED:
  		/* zero is disabled */
  		break;
  	case ENCLOSURE_SETTING_ENABLED:
  		desc[2] = 0x02;
  		break;
  	default:
  		/* SES doesn't do the SGPIO blink settings */
  		return -EINVAL;
  	}
  	return ses_set_page2_descriptor(edev, ecomp, desc);
  }
  
  static int ses_set_active(struct enclosure_device *edev,
  			  struct enclosure_component *ecomp,
  			  enum enclosure_component_setting val)
  {
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
238
  	unsigned char desc[4] = {0 };
9927c6886   James Bottomley   [SCSI] ses: add n...
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
  
  	switch (val) {
  	case ENCLOSURE_SETTING_DISABLED:
  		/* zero is disabled */
  		ecomp->active = 0;
  		break;
  	case ENCLOSURE_SETTING_ENABLED:
  		desc[2] = 0x80;
  		ecomp->active = 1;
  		break;
  	default:
  		/* SES doesn't do the SGPIO blink settings */
  		return -EINVAL;
  	}
  	return ses_set_page2_descriptor(edev, ecomp, desc);
  }
  
  static struct enclosure_component_callbacks ses_enclosure_callbacks = {
  	.get_fault		= ses_get_fault,
  	.set_fault		= ses_set_fault,
  	.get_status		= ses_get_status,
  	.get_locate		= ses_get_locate,
  	.set_locate		= ses_set_locate,
  	.set_active		= ses_set_active,
  };
  
  struct ses_host_edev {
  	struct Scsi_Host *shost;
  	struct enclosure_device *edev;
  };
e0aae1a53   Adrian Bunk   [SCSI] ses: #if 0...
269
  #if 0
9927c6886   James Bottomley   [SCSI] ses: add n...
270
271
272
273
  int ses_match_host(struct enclosure_device *edev, void *data)
  {
  	struct ses_host_edev *sed = data;
  	struct scsi_device *sdev;
ee959b00c   Tony Jones   SCSI: convert str...
274
  	if (!scsi_is_sdev_device(edev->edev.parent))
9927c6886   James Bottomley   [SCSI] ses: add n...
275
  		return 0;
ee959b00c   Tony Jones   SCSI: convert str...
276
  	sdev = to_scsi_device(edev->edev.parent);
9927c6886   James Bottomley   [SCSI] ses: add n...
277
278
279
280
281
282
283
  
  	if (sdev->host != sed->shost)
  		return 0;
  
  	sed->edev = edev;
  	return 1;
  }
e0aae1a53   Adrian Bunk   [SCSI] ses: #if 0...
284
  #endif  /*  0  */
9927c6886   James Bottomley   [SCSI] ses: add n...
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
  
  static void ses_process_descriptor(struct enclosure_component *ecomp,
  				   unsigned char *desc)
  {
  	int eip = desc[0] & 0x10;
  	int invalid = desc[0] & 0x80;
  	enum scsi_protocol proto = desc[0] & 0x0f;
  	u64 addr = 0;
  	struct ses_component *scomp = ecomp->scratch;
  	unsigned char *d;
  
  	scomp->desc = desc;
  
  	if (invalid)
  		return;
  
  	switch (proto) {
  	case SCSI_PROTOCOL_SAS:
  		if (eip)
  			d = desc + 8;
  		else
  			d = desc + 4;
  		/* only take the phy0 addr */
  		addr = (u64)d[12] << 56 |
  			(u64)d[13] << 48 |
  			(u64)d[14] << 40 |
  			(u64)d[15] << 32 |
  			(u64)d[16] << 24 |
  			(u64)d[17] << 16 |
  			(u64)d[18] << 8 |
  			(u64)d[19];
  		break;
  	default:
  		/* FIXME: Need to add more protocols than just SAS */
  		break;
  	}
  	scomp->addr = addr;
  }
  
  struct efd {
  	u64 addr;
  	struct device *dev;
  };
  
  static int ses_enclosure_find_by_addr(struct enclosure_device *edev,
  				      void *data)
  {
  	struct efd *efd = data;
  	int i;
  	struct ses_component *scomp;
  
  	if (!edev->component[0].scratch)
  		return 0;
  
  	for (i = 0; i < edev->components; i++) {
  		scomp = edev->component[i].scratch;
  		if (scomp->addr != efd->addr)
  			continue;
  
  		enclosure_add_device(edev, i, efd->dev);
  		return 1;
  	}
  	return 0;
  }
21fab1d05   James Bottomley   [SCSI] ses: updat...
349
350
351
352
353
354
355
356
357
358
  #define INIT_ALLOC_SIZE 32
  
  static void ses_enclosure_data_process(struct enclosure_device *edev,
  				       struct scsi_device *sdev,
  				       int create)
  {
  	u32 result;
  	unsigned char *buf = NULL, *type_ptr, *desc_ptr, *addl_desc_ptr = NULL;
  	int i, j, page7_len, len, components;
  	struct ses_device *ses_dev = edev->scratch;
8c3adc796   James Bottomley   [SCSI] ses: add s...
359
  	int types = ses_dev->page1_num_types;
21fab1d05   James Bottomley   [SCSI] ses: updat...
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
  	unsigned char *hdr_buf = kzalloc(INIT_ALLOC_SIZE, GFP_KERNEL);
  
  	if (!hdr_buf)
  		goto simple_populate;
  
  	/* re-read page 10 */
  	if (ses_dev->page10)
  		ses_recv_diag(sdev, 10, ses_dev->page10, ses_dev->page10_len);
  	/* Page 7 for the descriptors is optional */
  	result = ses_recv_diag(sdev, 7, hdr_buf, INIT_ALLOC_SIZE);
  	if (result)
  		goto simple_populate;
  
  	page7_len = len = (hdr_buf[2] << 8) + hdr_buf[3] + 4;
  	/* add 1 for trailing '\0' we'll use */
  	buf = kzalloc(len + 1, GFP_KERNEL);
  	if (!buf)
  		goto simple_populate;
  	result = ses_recv_diag(sdev, 7, buf, len);
  	if (result) {
   simple_populate:
  		kfree(buf);
  		buf = NULL;
  		desc_ptr = NULL;
  		len = 0;
  		page7_len = 0;
  	} else {
  		desc_ptr = buf + 8;
  		len = (desc_ptr[2] << 8) + desc_ptr[3];
  		/* skip past overall descriptor */
  		desc_ptr += len + 4;
21fab1d05   James Bottomley   [SCSI] ses: updat...
391
  	}
877a55979   John Hughes   [SCSI] ses: show ...
392
393
  	if (ses_dev->page10)
  		addl_desc_ptr = ses_dev->page10 + 8;
8c3adc796   James Bottomley   [SCSI] ses: add s...
394
  	type_ptr = ses_dev->page1_types;
21fab1d05   James Bottomley   [SCSI] ses: updat...
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
  	components = 0;
  	for (i = 0; i < types; i++, type_ptr += 4) {
  		for (j = 0; j < type_ptr[1]; j++) {
  			char *name = NULL;
  			struct enclosure_component *ecomp;
  
  			if (desc_ptr) {
  				if (desc_ptr >= buf + page7_len) {
  					desc_ptr = NULL;
  				} else {
  					len = (desc_ptr[2] << 8) + desc_ptr[3];
  					desc_ptr += 4;
  					/* Add trailing zero - pushes into
  					 * reserved space */
  					desc_ptr[len] = '\0';
  					name = desc_ptr;
  				}
  			}
  			if (type_ptr[0] == ENCLOSURE_COMPONENT_DEVICE ||
  			    type_ptr[0] == ENCLOSURE_COMPONENT_ARRAY_DEVICE) {
  
  				if (create)
  					ecomp =	enclosure_component_register(edev,
  									     components++,
  									     type_ptr[0],
  									     name);
  				else
  					ecomp = &edev->component[components++];
  
  				if (!IS_ERR(ecomp) && addl_desc_ptr)
  					ses_process_descriptor(ecomp,
  							       addl_desc_ptr);
  			}
  			if (desc_ptr)
  				desc_ptr += len;
  
  			if (addl_desc_ptr)
  				addl_desc_ptr += addl_desc_ptr[1] + 2;
  
  		}
  	}
  	kfree(buf);
  	kfree(hdr_buf);
  }
9927c6886   James Bottomley   [SCSI] ses: add n...
439
440
441
  static void ses_match_to_enclosure(struct enclosure_device *edev,
  				   struct scsi_device *sdev)
  {
40c3460f3   Matthew Wilcox   [SCSI] ses: Use n...
442
  	unsigned char *buf;
9927c6886   James Bottomley   [SCSI] ses: add n...
443
  	unsigned char *desc;
40c3460f3   Matthew Wilcox   [SCSI] ses: Use n...
444
  	unsigned int vpd_len;
9927c6886   James Bottomley   [SCSI] ses: add n...
445
446
447
  	struct efd efd = {
  		.addr = 0,
  	};
9927c6886   James Bottomley   [SCSI] ses: add n...
448

e3deec090   James Bottomley   [SCSI] eliminate ...
449
450
451
  	buf = kmalloc(INIT_ALLOC_SIZE, GFP_KERNEL);
  	if (!buf || scsi_get_vpd_page(sdev, 0x83, buf, INIT_ALLOC_SIZE))
  		goto free;
9927c6886   James Bottomley   [SCSI] ses: add n...
452

21fab1d05   James Bottomley   [SCSI] ses: updat...
453
  	ses_enclosure_data_process(edev, to_scsi_device(edev->edev.parent), 0);
40c3460f3   Matthew Wilcox   [SCSI] ses: Use n...
454
  	vpd_len = ((buf[2] << 8) | buf[3]) + 4;
e3deec090   James Bottomley   [SCSI] eliminate ...
455
456
457
458
  	kfree(buf);
  	buf = kmalloc(vpd_len, GFP_KERNEL);
  	if (!buf ||scsi_get_vpd_page(sdev, 0x83, buf, vpd_len))
  		goto free;
671a99c8e   James Bottomley   [SCSI] ses: fix V...
459

9927c6886   James Bottomley   [SCSI] ses: add n...
460
  	desc = buf + 4;
671a99c8e   James Bottomley   [SCSI] ses: fix V...
461
  	while (desc < buf + vpd_len) {
9927c6886   James Bottomley   [SCSI] ses: add n...
462
463
464
465
466
467
  		enum scsi_protocol proto = desc[0] >> 4;
  		u8 code_set = desc[0] & 0x0f;
  		u8 piv = desc[1] & 0x80;
  		u8 assoc = (desc[1] & 0x30) >> 4;
  		u8 type = desc[1] & 0x0f;
  		u8 len = desc[3];
b3f1f9aa0   Roel Kluin   [SCSI] ses: code_...
468
  		if (piv && code_set == 1 && assoc == 1
9927c6886   James Bottomley   [SCSI] ses: add n...
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
  		    && proto == SCSI_PROTOCOL_SAS && type == 3 && len == 8)
  			efd.addr = (u64)desc[4] << 56 |
  				(u64)desc[5] << 48 |
  				(u64)desc[6] << 40 |
  				(u64)desc[7] << 32 |
  				(u64)desc[8] << 24 |
  				(u64)desc[9] << 16 |
  				(u64)desc[10] << 8 |
  				(u64)desc[11];
  
  		desc += len + 4;
  	}
  	if (!efd.addr)
  		goto free;
  
  	efd.dev = &sdev->sdev_gendev;
  
  	enclosure_for_each_device(ses_enclosure_find_by_addr, &efd);
   free:
  	kfree(buf);
  }
ee959b00c   Tony Jones   SCSI: convert str...
490
  static int ses_intf_add(struct device *cdev,
9927c6886   James Bottomley   [SCSI] ses: add n...
491
492
  			struct class_interface *intf)
  {
ee959b00c   Tony Jones   SCSI: convert str...
493
  	struct scsi_device *sdev = to_scsi_device(cdev->parent);
9927c6886   James Bottomley   [SCSI] ses: add n...
494
  	struct scsi_device *tmp_sdev;
21fab1d05   James Bottomley   [SCSI] ses: updat...
495
  	unsigned char *buf = NULL, *hdr_buf, *type_ptr;
9927c6886   James Bottomley   [SCSI] ses: add n...
496
497
  	struct ses_device *ses_dev;
  	u32 result;
21fab1d05   James Bottomley   [SCSI] ses: updat...
498
  	int i, types, len, components = 0;
9927c6886   James Bottomley   [SCSI] ses: add n...
499
  	int err = -ENOMEM;
8c3adc796   James Bottomley   [SCSI] ses: add s...
500
  	int num_enclosures;
9927c6886   James Bottomley   [SCSI] ses: add n...
501
  	struct enclosure_device *edev;
7c46c20ae   Yinghai Lu   [SCSI] ses: fix m...
502
  	struct ses_component *scomp = NULL;
9927c6886   James Bottomley   [SCSI] ses: add n...
503
504
505
  
  	if (!scsi_device_enclosure(sdev)) {
  		/* not an enclosure, but might be in one */
163f52b6c   James Bottomley   [SCSI] ses: fix h...
506
507
508
  		struct enclosure_device *prev = NULL;
  
  		while ((edev = enclosure_find(&sdev->host->shost_gendev, prev)) != NULL) {
9927c6886   James Bottomley   [SCSI] ses: add n...
509
  			ses_match_to_enclosure(edev, sdev);
163f52b6c   James Bottomley   [SCSI] ses: fix h...
510
  			prev = edev;
9927c6886   James Bottomley   [SCSI] ses: add n...
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
  		}
  		return -ENODEV;
  	}
  
  	/* TYPE_ENCLOSURE prints a message in probe */
  	if (sdev->type != TYPE_ENCLOSURE)
  		sdev_printk(KERN_NOTICE, sdev, "Embedded Enclosure Device
  ");
  
  	ses_dev = kzalloc(sizeof(*ses_dev), GFP_KERNEL);
  	hdr_buf = kzalloc(INIT_ALLOC_SIZE, GFP_KERNEL);
  	if (!hdr_buf || !ses_dev)
  		goto err_init_free;
  
  	result = ses_recv_diag(sdev, 1, hdr_buf, INIT_ALLOC_SIZE);
  	if (result)
  		goto recv_failed;
9927c6886   James Bottomley   [SCSI] ses: add n...
528
529
530
531
  	len = (hdr_buf[2] << 8) + hdr_buf[3] + 4;
  	buf = kzalloc(len, GFP_KERNEL);
  	if (!buf)
  		goto err_free;
9927c6886   James Bottomley   [SCSI] ses: add n...
532
533
534
  	result = ses_recv_diag(sdev, 1, buf, len);
  	if (result)
  		goto recv_failed;
8c3adc796   James Bottomley   [SCSI] ses: add s...
535
  	types = 0;
9927c6886   James Bottomley   [SCSI] ses: add n...
536

8c3adc796   James Bottomley   [SCSI] ses: add s...
537
538
539
  	/* we always have one main enclosure and the rest are referred
  	 * to as secondary subenclosures */
  	num_enclosures = buf[1] + 1;
9927c6886   James Bottomley   [SCSI] ses: add n...
540

8c3adc796   James Bottomley   [SCSI] ses: add s...
541
542
543
544
545
546
547
548
549
550
551
552
  	/* begin at the enclosure descriptor */
  	type_ptr = buf + 8;
  	/* skip all the enclosure descriptors */
  	for (i = 0; i < num_enclosures && type_ptr < buf + len; i++) {
  		types += type_ptr[2];
  		type_ptr += type_ptr[3] + 4;
  	}
  
  	ses_dev->page1_types = type_ptr;
  	ses_dev->page1_num_types = types;
  
  	for (i = 0; i < types && type_ptr < buf + len; i++, type_ptr += 4) {
9927c6886   James Bottomley   [SCSI] ses: add n...
553
554
555
556
  		if (type_ptr[0] == ENCLOSURE_COMPONENT_DEVICE ||
  		    type_ptr[0] == ENCLOSURE_COMPONENT_ARRAY_DEVICE)
  			components += type_ptr[1];
  	}
7c46c20ae   Yinghai Lu   [SCSI] ses: fix m...
557
558
559
  	ses_dev->page1 = buf;
  	ses_dev->page1_len = len;
  	buf = NULL;
9927c6886   James Bottomley   [SCSI] ses: add n...
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
  
  	result = ses_recv_diag(sdev, 2, hdr_buf, INIT_ALLOC_SIZE);
  	if (result)
  		goto recv_failed;
  
  	len = (hdr_buf[2] << 8) + hdr_buf[3] + 4;
  	buf = kzalloc(len, GFP_KERNEL);
  	if (!buf)
  		goto err_free;
  
  	/* make sure getting page 2 actually works */
  	result = ses_recv_diag(sdev, 2, buf, len);
  	if (result)
  		goto recv_failed;
  	ses_dev->page2 = buf;
  	ses_dev->page2_len = len;
7c46c20ae   Yinghai Lu   [SCSI] ses: fix m...
576
  	buf = NULL;
9927c6886   James Bottomley   [SCSI] ses: add n...
577
578
579
580
  
  	/* The additional information page --- allows us
  	 * to match up the devices */
  	result = ses_recv_diag(sdev, 10, hdr_buf, INIT_ALLOC_SIZE);
691b4773a   Yinghai Lu   [SCSI] ses: fix d...
581
582
583
584
585
586
587
588
589
590
591
592
593
594
  	if (!result) {
  
  		len = (hdr_buf[2] << 8) + hdr_buf[3] + 4;
  		buf = kzalloc(len, GFP_KERNEL);
  		if (!buf)
  			goto err_free;
  
  		result = ses_recv_diag(sdev, 10, buf, len);
  		if (result)
  			goto recv_failed;
  		ses_dev->page10 = buf;
  		ses_dev->page10_len = len;
  		buf = NULL;
  	}
7c46c20ae   Yinghai Lu   [SCSI] ses: fix m...
595
  	scomp = kzalloc(sizeof(struct ses_component) * components, GFP_KERNEL);
9927c6886   James Bottomley   [SCSI] ses: add n...
596
  	if (!scomp)
7c46c20ae   Yinghai Lu   [SCSI] ses: fix m...
597
  		goto err_free;
9927c6886   James Bottomley   [SCSI] ses: add n...
598

71610f55f   Kay Sievers   [SCSI] struct dev...
599
  	edev = enclosure_register(cdev->parent, dev_name(&sdev->sdev_gendev),
9927c6886   James Bottomley   [SCSI] ses: add n...
600
601
602
603
604
  				  components, &ses_enclosure_callbacks);
  	if (IS_ERR(edev)) {
  		err = PTR_ERR(edev);
  		goto err_free;
  	}
9b3a6549b   Julia Lawall   drivers/scsi/ses....
605
  	kfree(hdr_buf);
9927c6886   James Bottomley   [SCSI] ses: add n...
606
607
  	edev->scratch = ses_dev;
  	for (i = 0; i < components; i++)
7c46c20ae   Yinghai Lu   [SCSI] ses: fix m...
608
  		edev->component[i].scratch = scomp + i;
9927c6886   James Bottomley   [SCSI] ses: add n...
609

21fab1d05   James Bottomley   [SCSI] ses: updat...
610
  	ses_enclosure_data_process(edev, sdev, 1);
9927c6886   James Bottomley   [SCSI] ses: add n...
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
  
  	/* see if there are any devices matching before
  	 * we found the enclosure */
  	shost_for_each_device(tmp_sdev, sdev->host) {
  		if (tmp_sdev->lun != 0 || scsi_device_enclosure(tmp_sdev))
  			continue;
  		ses_match_to_enclosure(edev, tmp_sdev);
  	}
  
  	return 0;
  
   recv_failed:
  	sdev_printk(KERN_ERR, sdev, "Failed to get diagnostic page 0x%x
  ",
  		    result);
  	err = -ENODEV;
   err_free:
  	kfree(buf);
7c46c20ae   Yinghai Lu   [SCSI] ses: fix m...
629
  	kfree(scomp);
9927c6886   James Bottomley   [SCSI] ses: add n...
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
  	kfree(ses_dev->page10);
  	kfree(ses_dev->page2);
  	kfree(ses_dev->page1);
   err_init_free:
  	kfree(ses_dev);
  	kfree(hdr_buf);
  	sdev_printk(KERN_ERR, sdev, "Failed to bind enclosure %d
  ", err);
  	return err;
  }
  
  static int ses_remove(struct device *dev)
  {
  	return 0;
  }
43d8eb9cf   James Bottomley   [SCSI] ses: add s...
645
646
647
648
649
650
651
652
653
654
655
656
657
658
  static void ses_intf_remove_component(struct scsi_device *sdev)
  {
  	struct enclosure_device *edev, *prev = NULL;
  
  	while ((edev = enclosure_find(&sdev->host->shost_gendev, prev)) != NULL) {
  		prev = edev;
  		if (!enclosure_remove_device(edev, &sdev->sdev_gendev))
  			break;
  	}
  	if (edev)
  		put_device(&edev->edev);
  }
  
  static void ses_intf_remove_enclosure(struct scsi_device *sdev)
9927c6886   James Bottomley   [SCSI] ses: add n...
659
  {
9927c6886   James Bottomley   [SCSI] ses: add n...
660
661
  	struct enclosure_device *edev;
  	struct ses_device *ses_dev;
163f52b6c   James Bottomley   [SCSI] ses: fix h...
662
  	/*  exact match to this enclosure */
43d8eb9cf   James Bottomley   [SCSI] ses: add s...
663
  	edev = enclosure_find(&sdev->sdev_gendev, NULL);
9927c6886   James Bottomley   [SCSI] ses: add n...
664
665
666
667
668
  	if (!edev)
  		return;
  
  	ses_dev = edev->scratch;
  	edev->scratch = NULL;
7c46c20ae   Yinghai Lu   [SCSI] ses: fix m...
669
  	kfree(ses_dev->page10);
9927c6886   James Bottomley   [SCSI] ses: add n...
670
671
672
673
674
  	kfree(ses_dev->page1);
  	kfree(ses_dev->page2);
  	kfree(ses_dev);
  
  	kfree(edev->component[0].scratch);
ee959b00c   Tony Jones   SCSI: convert str...
675
  	put_device(&edev->edev);
9927c6886   James Bottomley   [SCSI] ses: add n...
676
677
  	enclosure_unregister(edev);
  }
43d8eb9cf   James Bottomley   [SCSI] ses: add s...
678
679
680
681
682
683
684
685
686
687
  static void ses_intf_remove(struct device *cdev,
  			    struct class_interface *intf)
  {
  	struct scsi_device *sdev = to_scsi_device(cdev->parent);
  
  	if (!scsi_device_enclosure(sdev))
  		ses_intf_remove_component(sdev);
  	else
  		ses_intf_remove_enclosure(sdev);
  }
9927c6886   James Bottomley   [SCSI] ses: add n...
688
  static struct class_interface ses_interface = {
ee959b00c   Tony Jones   SCSI: convert str...
689
690
  	.add_dev	= ses_intf_add,
  	.remove_dev	= ses_intf_remove,
9927c6886   James Bottomley   [SCSI] ses: add n...
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
  };
  
  static struct scsi_driver ses_template = {
  	.owner			= THIS_MODULE,
  	.gendrv = {
  		.name		= "ses",
  		.probe		= ses_probe,
  		.remove		= ses_remove,
  	},
  };
  
  static int __init ses_init(void)
  {
  	int err;
  
  	err = scsi_register_interface(&ses_interface);
  	if (err)
  		return err;
  
  	err = scsi_register_driver(&ses_template.gendrv);
  	if (err)
  		goto out_unreg;
  
  	return 0;
  
   out_unreg:
  	scsi_unregister_interface(&ses_interface);
  	return err;
  }
  
  static void __exit ses_exit(void)
  {
  	scsi_unregister_driver(&ses_template.gendrv);
  	scsi_unregister_interface(&ses_interface);
  }
  
  module_init(ses_init);
  module_exit(ses_exit);
  
  MODULE_ALIAS_SCSI_DEVICE(TYPE_ENCLOSURE);
  
  MODULE_AUTHOR("James Bottomley");
  MODULE_DESCRIPTION("SCSI Enclosure Services (ses) driver");
  MODULE_LICENSE("GPL v2");