Linux Audio

Check our new training course

Loading...
v3.1
 
  1/*
  2 *  CCW device SENSE ID I/O handling.
  3 *
  4 *    Copyright IBM Corp. 2002,2009
  5 *    Author(s): Cornelia Huck <cornelia.huck@de.ibm.com>
  6 *		 Martin Schwidefsky <schwidefsky@de.ibm.com>
  7 *		 Peter Oberparleiter <peter.oberparleiter@de.ibm.com>
  8 */
  9
 10#include <linux/kernel.h>
 11#include <linux/string.h>
 12#include <linux/types.h>
 13#include <linux/errno.h>
 14#include <asm/ccwdev.h>
 15#include <asm/setup.h>
 16#include <asm/cio.h>
 17#include <asm/diag.h>
 18
 19#include "cio.h"
 20#include "cio_debug.h"
 21#include "device.h"
 22#include "io_sch.h"
 23
 24#define SENSE_ID_RETRIES	256
 25#define SENSE_ID_TIMEOUT	(10 * HZ)
 26#define SENSE_ID_MIN_LEN	4
 27#define SENSE_ID_BASIC_LEN	7
 28
 29/**
 30 * diag210_to_senseid - convert diag 0x210 data to sense id information
 31 * @senseid: sense id
 32 * @diag: diag 0x210 data
 33 *
 34 * Return 0 on success, non-zero otherwise.
 35 */
 36static int diag210_to_senseid(struct senseid *senseid, struct diag210 *diag)
 37{
 38	static struct {
 39		int class, type, cu_type;
 40	} vm_devices[] = {
 41		{ 0x08, 0x01, 0x3480 },
 42		{ 0x08, 0x02, 0x3430 },
 43		{ 0x08, 0x10, 0x3420 },
 44		{ 0x08, 0x42, 0x3424 },
 45		{ 0x08, 0x44, 0x9348 },
 46		{ 0x08, 0x81, 0x3490 },
 47		{ 0x08, 0x82, 0x3422 },
 48		{ 0x10, 0x41, 0x1403 },
 49		{ 0x10, 0x42, 0x3211 },
 50		{ 0x10, 0x43, 0x3203 },
 51		{ 0x10, 0x45, 0x3800 },
 52		{ 0x10, 0x47, 0x3262 },
 53		{ 0x10, 0x48, 0x3820 },
 54		{ 0x10, 0x49, 0x3800 },
 55		{ 0x10, 0x4a, 0x4245 },
 56		{ 0x10, 0x4b, 0x4248 },
 57		{ 0x10, 0x4d, 0x3800 },
 58		{ 0x10, 0x4e, 0x3820 },
 59		{ 0x10, 0x4f, 0x3820 },
 60		{ 0x10, 0x82, 0x2540 },
 61		{ 0x10, 0x84, 0x3525 },
 62		{ 0x20, 0x81, 0x2501 },
 63		{ 0x20, 0x82, 0x2540 },
 64		{ 0x20, 0x84, 0x3505 },
 65		{ 0x40, 0x01, 0x3278 },
 66		{ 0x40, 0x04, 0x3277 },
 67		{ 0x40, 0x80, 0x2250 },
 68		{ 0x40, 0xc0, 0x5080 },
 69		{ 0x80, 0x00, 0x3215 },
 70	};
 71	int i;
 72
 73	/* Special case for osa devices. */
 74	if (diag->vrdcvcla == 0x02 && diag->vrdcvtyp == 0x20) {
 75		senseid->cu_type = 0x3088;
 76		senseid->cu_model = 0x60;
 77		senseid->reserved = 0xff;
 78		return 0;
 79	}
 80	for (i = 0; i < ARRAY_SIZE(vm_devices); i++) {
 81		if (diag->vrdcvcla == vm_devices[i].class &&
 82		    diag->vrdcvtyp == vm_devices[i].type) {
 83			senseid->cu_type = vm_devices[i].cu_type;
 84			senseid->reserved = 0xff;
 85			return 0;
 86		}
 87	}
 88
 89	return -ENODEV;
 90}
 91
 92/**
 93 * diag_get_dev_info - retrieve device information via diag 0x210
 94 * @cdev: ccw device
 95 *
 96 * Returns zero on success, non-zero otherwise.
 97 */
 98static int diag210_get_dev_info(struct ccw_device *cdev)
 99{
100	struct ccw_dev_id *dev_id = &cdev->private->dev_id;
101	struct senseid *senseid = &cdev->private->senseid;
102	struct diag210 diag_data;
103	int rc;
104
105	if (dev_id->ssid != 0)
106		return -ENODEV;
107	memset(&diag_data, 0, sizeof(diag_data));
108	diag_data.vrdcdvno	= dev_id->devno;
109	diag_data.vrdclen	= sizeof(diag_data);
110	rc = diag210(&diag_data);
111	CIO_TRACE_EVENT(4, "diag210");
112	CIO_HEX_EVENT(4, &rc, sizeof(rc));
113	CIO_HEX_EVENT(4, &diag_data, sizeof(diag_data));
114	if (rc != 0 && rc != 2)
115		goto err_failed;
116	if (diag210_to_senseid(senseid, &diag_data))
117		goto err_unknown;
118	return 0;
119
120err_unknown:
121	CIO_MSG_EVENT(0, "snsid: device 0.%x.%04x: unknown diag210 data\n",
122		      dev_id->ssid, dev_id->devno);
123	return -ENODEV;
124err_failed:
125	CIO_MSG_EVENT(0, "snsid: device 0.%x.%04x: diag210 failed (rc=%d)\n",
126		      dev_id->ssid, dev_id->devno, rc);
127	return -ENODEV;
128}
129
130/*
131 * Initialize SENSE ID data.
132 */
133static void snsid_init(struct ccw_device *cdev)
134{
135	cdev->private->flags.esid = 0;
136	memset(&cdev->private->senseid, 0, sizeof(cdev->private->senseid));
137	cdev->private->senseid.cu_type = 0xffff;
 
 
138}
139
140/*
141 * Check for complete SENSE ID data.
142 */
143static int snsid_check(struct ccw_device *cdev, void *data)
144{
145	struct cmd_scsw *scsw = &cdev->private->irb.scsw.cmd;
146	int len = sizeof(struct senseid) - scsw->count;
147
148	/* Check for incomplete SENSE ID data. */
149	if (len < SENSE_ID_MIN_LEN)
150		goto out_restart;
151	if (cdev->private->senseid.cu_type == 0xffff)
152		goto out_restart;
153	/* Check for incompatible SENSE ID data. */
154	if (cdev->private->senseid.reserved != 0xff)
155		return -EOPNOTSUPP;
156	/* Check for extended-identification information. */
157	if (len > SENSE_ID_BASIC_LEN)
158		cdev->private->flags.esid = 1;
159	return 0;
160
161out_restart:
162	snsid_init(cdev);
163	return -EAGAIN;
164}
165
166/*
167 * Process SENSE ID request result.
168 */
169static void snsid_callback(struct ccw_device *cdev, void *data, int rc)
170{
171	struct ccw_dev_id *id = &cdev->private->dev_id;
172	struct senseid *senseid = &cdev->private->senseid;
173	int vm = 0;
174
175	if (rc && MACHINE_IS_VM) {
176		/* Try diag 0x210 fallback on z/VM. */
177		snsid_init(cdev);
178		if (diag210_get_dev_info(cdev) == 0) {
179			rc = 0;
180			vm = 1;
181		}
182	}
183	CIO_MSG_EVENT(2, "snsid: device 0.%x.%04x: rc=%d %04x/%02x "
184		      "%04x/%02x%s\n", id->ssid, id->devno, rc,
185		      senseid->cu_type, senseid->cu_model, senseid->dev_type,
186		      senseid->dev_model, vm ? " (diag210)" : "");
187	ccw_device_sense_id_done(cdev, rc);
188}
189
190/**
191 * ccw_device_sense_id_start - perform SENSE ID
192 * @cdev: ccw device
193 *
194 * Execute a SENSE ID channel program on @cdev to update its sense id
195 * information. When finished, call ccw_device_sense_id_done with a
196 * return code specifying the result.
197 */
198void ccw_device_sense_id_start(struct ccw_device *cdev)
199{
200	struct subchannel *sch = to_subchannel(cdev->dev.parent);
201	struct ccw_request *req = &cdev->private->req;
202	struct ccw1 *cp = cdev->private->iccws;
203
204	CIO_TRACE_EVENT(4, "snsid");
205	CIO_HEX_EVENT(4, &cdev->private->dev_id, sizeof(cdev->private->dev_id));
206	/* Data setup. */
207	snsid_init(cdev);
208	/* Channel program setup. */
209	cp->cmd_code	= CCW_CMD_SENSE_ID;
210	cp->cda		= (u32) (addr_t) &cdev->private->senseid;
211	cp->count	= sizeof(struct senseid);
212	cp->flags	= CCW_FLAG_SLI;
213	/* Request setup. */
214	memset(req, 0, sizeof(*req));
215	req->cp		= cp;
216	req->timeout	= SENSE_ID_TIMEOUT;
217	req->maxretries	= SENSE_ID_RETRIES;
218	req->lpm	= sch->schib.pmcw.pam & sch->opm;
219	req->check	= snsid_check;
220	req->callback	= snsid_callback;
221	ccw_request_start(cdev);
222}
v5.4
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 *  CCW device SENSE ID I/O handling.
  4 *
  5 *    Copyright IBM Corp. 2002, 2009
  6 *    Author(s): Cornelia Huck <cornelia.huck@de.ibm.com>
  7 *		 Martin Schwidefsky <schwidefsky@de.ibm.com>
  8 *		 Peter Oberparleiter <peter.oberparleiter@de.ibm.com>
  9 */
 10
 11#include <linux/kernel.h>
 12#include <linux/string.h>
 13#include <linux/types.h>
 14#include <linux/errno.h>
 15#include <asm/ccwdev.h>
 16#include <asm/setup.h>
 17#include <asm/cio.h>
 18#include <asm/diag.h>
 19
 20#include "cio.h"
 21#include "cio_debug.h"
 22#include "device.h"
 23#include "io_sch.h"
 24
 25#define SENSE_ID_RETRIES	256
 26#define SENSE_ID_TIMEOUT	(10 * HZ)
 27#define SENSE_ID_MIN_LEN	4
 28#define SENSE_ID_BASIC_LEN	7
 29
 30/**
 31 * diag210_to_senseid - convert diag 0x210 data to sense id information
 32 * @senseid: sense id
 33 * @diag: diag 0x210 data
 34 *
 35 * Return 0 on success, non-zero otherwise.
 36 */
 37static int diag210_to_senseid(struct senseid *senseid, struct diag210 *diag)
 38{
 39	static struct {
 40		int class, type, cu_type;
 41	} vm_devices[] = {
 42		{ 0x08, 0x01, 0x3480 },
 43		{ 0x08, 0x02, 0x3430 },
 44		{ 0x08, 0x10, 0x3420 },
 45		{ 0x08, 0x42, 0x3424 },
 46		{ 0x08, 0x44, 0x9348 },
 47		{ 0x08, 0x81, 0x3490 },
 48		{ 0x08, 0x82, 0x3422 },
 49		{ 0x10, 0x41, 0x1403 },
 50		{ 0x10, 0x42, 0x3211 },
 51		{ 0x10, 0x43, 0x3203 },
 52		{ 0x10, 0x45, 0x3800 },
 53		{ 0x10, 0x47, 0x3262 },
 54		{ 0x10, 0x48, 0x3820 },
 55		{ 0x10, 0x49, 0x3800 },
 56		{ 0x10, 0x4a, 0x4245 },
 57		{ 0x10, 0x4b, 0x4248 },
 58		{ 0x10, 0x4d, 0x3800 },
 59		{ 0x10, 0x4e, 0x3820 },
 60		{ 0x10, 0x4f, 0x3820 },
 61		{ 0x10, 0x82, 0x2540 },
 62		{ 0x10, 0x84, 0x3525 },
 63		{ 0x20, 0x81, 0x2501 },
 64		{ 0x20, 0x82, 0x2540 },
 65		{ 0x20, 0x84, 0x3505 },
 66		{ 0x40, 0x01, 0x3278 },
 67		{ 0x40, 0x04, 0x3277 },
 68		{ 0x40, 0x80, 0x2250 },
 69		{ 0x40, 0xc0, 0x5080 },
 70		{ 0x80, 0x00, 0x3215 },
 71	};
 72	int i;
 73
 74	/* Special case for osa devices. */
 75	if (diag->vrdcvcla == 0x02 && diag->vrdcvtyp == 0x20) {
 76		senseid->cu_type = 0x3088;
 77		senseid->cu_model = 0x60;
 78		senseid->reserved = 0xff;
 79		return 0;
 80	}
 81	for (i = 0; i < ARRAY_SIZE(vm_devices); i++) {
 82		if (diag->vrdcvcla == vm_devices[i].class &&
 83		    diag->vrdcvtyp == vm_devices[i].type) {
 84			senseid->cu_type = vm_devices[i].cu_type;
 85			senseid->reserved = 0xff;
 86			return 0;
 87		}
 88	}
 89
 90	return -ENODEV;
 91}
 92
 93/**
 94 * diag_get_dev_info - retrieve device information via diag 0x210
 95 * @cdev: ccw device
 96 *
 97 * Returns zero on success, non-zero otherwise.
 98 */
 99static int diag210_get_dev_info(struct ccw_device *cdev)
100{
101	struct ccw_dev_id *dev_id = &cdev->private->dev_id;
102	struct senseid *senseid = &cdev->private->dma_area->senseid;
103	struct diag210 diag_data;
104	int rc;
105
106	if (dev_id->ssid != 0)
107		return -ENODEV;
108	memset(&diag_data, 0, sizeof(diag_data));
109	diag_data.vrdcdvno	= dev_id->devno;
110	diag_data.vrdclen	= sizeof(diag_data);
111	rc = diag210(&diag_data);
112	CIO_TRACE_EVENT(4, "diag210");
113	CIO_HEX_EVENT(4, &rc, sizeof(rc));
114	CIO_HEX_EVENT(4, &diag_data, sizeof(diag_data));
115	if (rc != 0 && rc != 2)
116		goto err_failed;
117	if (diag210_to_senseid(senseid, &diag_data))
118		goto err_unknown;
119	return 0;
120
121err_unknown:
122	CIO_MSG_EVENT(0, "snsid: device 0.%x.%04x: unknown diag210 data\n",
123		      dev_id->ssid, dev_id->devno);
124	return -ENODEV;
125err_failed:
126	CIO_MSG_EVENT(0, "snsid: device 0.%x.%04x: diag210 failed (rc=%d)\n",
127		      dev_id->ssid, dev_id->devno, rc);
128	return -ENODEV;
129}
130
131/*
132 * Initialize SENSE ID data.
133 */
134static void snsid_init(struct ccw_device *cdev)
135{
136	cdev->private->flags.esid = 0;
137
138	memset(&cdev->private->dma_area->senseid, 0,
139	       sizeof(cdev->private->dma_area->senseid));
140	cdev->private->dma_area->senseid.cu_type = 0xffff;
141}
142
143/*
144 * Check for complete SENSE ID data.
145 */
146static int snsid_check(struct ccw_device *cdev, void *data)
147{
148	struct cmd_scsw *scsw = &cdev->private->dma_area->irb.scsw.cmd;
149	int len = sizeof(struct senseid) - scsw->count;
150
151	/* Check for incomplete SENSE ID data. */
152	if (len < SENSE_ID_MIN_LEN)
153		goto out_restart;
154	if (cdev->private->dma_area->senseid.cu_type == 0xffff)
155		goto out_restart;
156	/* Check for incompatible SENSE ID data. */
157	if (cdev->private->dma_area->senseid.reserved != 0xff)
158		return -EOPNOTSUPP;
159	/* Check for extended-identification information. */
160	if (len > SENSE_ID_BASIC_LEN)
161		cdev->private->flags.esid = 1;
162	return 0;
163
164out_restart:
165	snsid_init(cdev);
166	return -EAGAIN;
167}
168
169/*
170 * Process SENSE ID request result.
171 */
172static void snsid_callback(struct ccw_device *cdev, void *data, int rc)
173{
174	struct ccw_dev_id *id = &cdev->private->dev_id;
175	struct senseid *senseid = &cdev->private->dma_area->senseid;
176	int vm = 0;
177
178	if (rc && MACHINE_IS_VM) {
179		/* Try diag 0x210 fallback on z/VM. */
180		snsid_init(cdev);
181		if (diag210_get_dev_info(cdev) == 0) {
182			rc = 0;
183			vm = 1;
184		}
185	}
186	CIO_MSG_EVENT(2, "snsid: device 0.%x.%04x: rc=%d %04x/%02x "
187		      "%04x/%02x%s\n", id->ssid, id->devno, rc,
188		      senseid->cu_type, senseid->cu_model, senseid->dev_type,
189		      senseid->dev_model, vm ? " (diag210)" : "");
190	ccw_device_sense_id_done(cdev, rc);
191}
192
193/**
194 * ccw_device_sense_id_start - perform SENSE ID
195 * @cdev: ccw device
196 *
197 * Execute a SENSE ID channel program on @cdev to update its sense id
198 * information. When finished, call ccw_device_sense_id_done with a
199 * return code specifying the result.
200 */
201void ccw_device_sense_id_start(struct ccw_device *cdev)
202{
203	struct subchannel *sch = to_subchannel(cdev->dev.parent);
204	struct ccw_request *req = &cdev->private->req;
205	struct ccw1 *cp = cdev->private->dma_area->iccws;
206
207	CIO_TRACE_EVENT(4, "snsid");
208	CIO_HEX_EVENT(4, &cdev->private->dev_id, sizeof(cdev->private->dev_id));
209	/* Data setup. */
210	snsid_init(cdev);
211	/* Channel program setup. */
212	cp->cmd_code	= CCW_CMD_SENSE_ID;
213	cp->cda		= (u32) (addr_t) &cdev->private->dma_area->senseid;
214	cp->count	= sizeof(struct senseid);
215	cp->flags	= CCW_FLAG_SLI;
216	/* Request setup. */
217	memset(req, 0, sizeof(*req));
218	req->cp		= cp;
219	req->timeout	= SENSE_ID_TIMEOUT;
220	req->maxretries	= SENSE_ID_RETRIES;
221	req->lpm	= sch->schib.pmcw.pam & sch->opm;
222	req->check	= snsid_check;
223	req->callback	= snsid_callback;
224	ccw_request_start(cdev);
225}