s390/cio/qdio_setup.c

91 void qdio_free_queues(struct qdio_irq *irq_ptr)
93 	__qdio_free_queues(irq_ptr->input_qs, irq_ptr->max_input_qs);
94 	irq_ptr->max_input_qs = 0;
96 	__qdio_free_queues(irq_ptr->output_qs, irq_ptr->max_output_qs);
97 	irq_ptr->max_output_qs = 0;
123 int qdio_allocate_qs(struct qdio_irq *irq_ptr, int nr_input_qs, int nr_output_qs)
127 	rc = __qdio_allocate_qs(irq_ptr->input_qs, nr_input_qs);
131 	rc = __qdio_allocate_qs(irq_ptr->output_qs, nr_output_qs);
133 		__qdio_free_queues(irq_ptr->input_qs, nr_input_qs);
137 	irq_ptr->max_input_qs = nr_input_qs;
138 	irq_ptr->max_output_qs = nr_output_qs;
142 static void setup_queues_misc(struct qdio_q *q, struct qdio_irq *irq_ptr,
151 	q->irq_ptr = irq_ptr;
157 static void setup_storage_lists(struct qdio_q *q, struct qdio_irq *irq_ptr,
172 		prev = (q->is_input_q) ? irq_ptr->input_qs[i - 1]
173 			: irq_ptr->output_qs[i - 1];
185 static void setup_queues(struct qdio_irq *irq_ptr,
191 	for_each_input_queue(irq_ptr, q, i) {
193 		setup_queues_misc(q, irq_ptr, qdio_init->input_handler, i);
197 		setup_storage_lists(q, irq_ptr,
201 	for_each_output_queue(irq_ptr, q, i) {
203 		setup_queues_misc(q, irq_ptr, qdio_init->output_handler, i);
206 		setup_storage_lists(q, irq_ptr,
211 static void check_and_setup_qebsm(struct qdio_irq *irq_ptr,
214 	if (!(irq_ptr->qib.rflags & QIB_RFLAGS_ENABLE_QEBSM))
220 	irq_ptr->sch_token = token;
223 	DBF_EVENT("%8lx", irq_ptr->sch_token);
227 	irq_ptr->sch_token = 0;
228 	irq_ptr->qib.rflags &= ~QIB_RFLAGS_ENABLE_QEBSM;
236 int qdio_setup_get_ssqd(struct qdio_irq *irq_ptr,
244 	if (!irq_ptr) {
249 		ssqd = (struct chsc_ssqd_area *)irq_ptr->chsc_page;
265 	if (!irq_ptr)
271 void qdio_setup_ssqd_info(struct qdio_irq *irq_ptr)
276 	rc = qdio_setup_get_ssqd(irq_ptr, &irq_ptr->schid, &irq_ptr->ssqd_desc);
278 		DBF_ERROR("%4x ssqd ERR", irq_ptr->schid.sch_no);
284 		qdioac = irq_ptr->ssqd_desc.qdioac1;
286 	check_and_setup_qebsm(irq_ptr, qdioac, irq_ptr->ssqd_desc.sch_token);
287 	irq_ptr->qdioac1 = qdioac;
288 	DBF_EVENT("ac 1:%2x 2:%4x", qdioac, irq_ptr->ssqd_desc.qdioac2);
289 	DBF_EVENT("3:%4x qib:%4x", irq_ptr->ssqd_desc.qdioac3, irq_ptr->qib.ac);
304 static void setup_qdr(struct qdio_irq *irq_ptr,
307 	struct qdesfmt0 *desc = &irq_ptr->qdr->qdf0[0];
310 	memset(irq_ptr->qdr, 0, sizeof(struct qdr));
312 	irq_ptr->qdr->qfmt = qdio_init->q_format;
313 	irq_ptr->qdr->ac = qdio_init->qdr_ac;
314 	irq_ptr->qdr->iqdcnt = qdio_init->no_input_qs;
315 	irq_ptr->qdr->oqdcnt = qdio_init->no_output_qs;
316 	irq_ptr->qdr->iqdsz = sizeof(struct qdesfmt0) / 4; /* size in words */
317 	irq_ptr->qdr->oqdsz = sizeof(struct qdesfmt0) / 4;
318 	irq_ptr->qdr->qiba = virt_to_dma64(&irq_ptr->qib);
319 	irq_ptr->qdr->qkey = PAGE_DEFAULT_KEY >> 4;
322 		qdio_fill_qdr_desc(desc++, irq_ptr->input_qs[i]);
325 		qdio_fill_qdr_desc(desc++, irq_ptr->output_qs[i]);
328 static void setup_qib(struct qdio_irq *irq_ptr,
331 	memset(&irq_ptr->qib, 0, sizeof(irq_ptr->qib));
333 	irq_ptr->qib.qfmt = init_data->q_format;
334 	irq_ptr->qib.pfmt = init_data->qib_param_field_format;
336 	irq_ptr->qib.rflags = init_data->qib_rflags;
338 		irq_ptr->qib.rflags |= QIB_RFLAGS_ENABLE_QEBSM;
341 		irq_ptr->qib.isliba =
342 			(unsigned long)(irq_ptr->input_qs[0]->slib);
344 		irq_ptr->qib.osliba =
345 			(unsigned long)(irq_ptr->output_qs[0]->slib);
346 	memcpy(irq_ptr->qib.ebcnam, dev_name(&irq_ptr->cdev->dev), 8);
347 	ASCEBC(irq_ptr->qib.ebcnam, 8);
350 		memcpy(irq_ptr->qib.parm, init_data->qib_param_field,
351 		       sizeof(irq_ptr->qib.parm));
354 void qdio_setup_irq(struct qdio_irq *irq_ptr, struct qdio_initialize *init_data)
356 	struct ccw_device *cdev = irq_ptr->cdev;
358 	irq_ptr->qdioac1 = 0;
359 	memset(&irq_ptr->ssqd_desc, 0, sizeof(irq_ptr->ssqd_desc));
360 	memset(&irq_ptr->perf_stat, 0, sizeof(irq_ptr->perf_stat));
362 	irq_ptr->debugfs_dev = NULL;
363 	irq_ptr->sch_token = irq_ptr->perf_stat_enabled = 0;
364 	irq_ptr->state = QDIO_IRQ_STATE_INACTIVE;
365 	irq_ptr->error_handler = init_data->input_handler;
367 	irq_ptr->int_parm = init_data->int_parm;
368 	irq_ptr->nr_input_qs = init_data->no_input_qs;
369 	irq_ptr->nr_output_qs = init_data->no_output_qs;
370 	ccw_device_get_schid(cdev, &irq_ptr->schid);
371 	setup_queues(irq_ptr, init_data);
373 	irq_ptr->irq_poll = init_data->irq_poll;
374 	set_bit(QDIO_IRQ_DISABLED, &irq_ptr->poll_state);
376 	setup_qib(irq_ptr, init_data);
379 	setup_qdr(irq_ptr, init_data);
385 	irq_ptr->orig_handler = cdev->handler;
401 void qdio_print_subchannel_info(struct qdio_irq *irq_ptr)
403 	dev_info(&irq_ptr->cdev->dev,
405 		 (irq_ptr->qib.qfmt == QDIO_QETH_QFMT) ? "OSA" :
406 			((irq_ptr->qib.qfmt == QDIO_ZFCP_QFMT) ? "ZFCP" : "HS"),
407 		 irq_ptr->schid.sch_no,
408 		 is_thinint_irq(irq_ptr),
409 		 (irq_ptr->sch_token) ? 1 : 0,
410 		 pci_out_supported(irq_ptr) ? 1 : 0,
412 		 qdio_need_siga_in(irq_ptr) ? "R" : " ",
413 		 qdio_need_siga_out(irq_ptr) ? "W" : " ",
414 		 qdio_need_siga_sync(irq_ptr) ? "S" : " ");