Commit bbd50e17 authored by Jan Glauber's avatar Jan Glauber Committed by Martin Schwidefsky

[S390] qdio: fix qeth port count detection

qeth needs to get the port count information before
qdio has allocated a page for the chsc operation.
Extend qdio_get_ssqd_desc() to store the data in the
specified structure.
Signed-off-by: default avatarJan Glauber <jang@linux.vnet.ibm.com>
Signed-off-by: default avatarMartin Schwidefsky <schwidefsky@de.ibm.com>
parent 43c207e6
...@@ -373,16 +373,16 @@ struct qdio_initialize { ...@@ -373,16 +373,16 @@ struct qdio_initialize {
#define QDIO_FLAG_SYNC_OUTPUT 0x02 #define QDIO_FLAG_SYNC_OUTPUT 0x02
#define QDIO_FLAG_PCI_OUT 0x10 #define QDIO_FLAG_PCI_OUT 0x10
extern int qdio_initialize(struct qdio_initialize *init_data); extern int qdio_initialize(struct qdio_initialize *);
extern int qdio_allocate(struct qdio_initialize *init_data); extern int qdio_allocate(struct qdio_initialize *);
extern int qdio_establish(struct qdio_initialize *init_data); extern int qdio_establish(struct qdio_initialize *);
extern int qdio_activate(struct ccw_device *); extern int qdio_activate(struct ccw_device *);
extern int do_QDIO(struct ccw_device*, unsigned int flags, extern int do_QDIO(struct ccw_device *cdev, unsigned int callflags,
int q_nr, int qidx, int count); int q_nr, int bufnr, int count);
extern int qdio_cleanup(struct ccw_device*, int how); extern int qdio_cleanup(struct ccw_device*, int);
extern int qdio_shutdown(struct ccw_device*, int how); extern int qdio_shutdown(struct ccw_device*, int);
extern int qdio_free(struct ccw_device *); extern int qdio_free(struct ccw_device *);
extern struct qdio_ssqd_desc *qdio_get_ssqd_desc(struct ccw_device *cdev); extern int qdio_get_ssqd_desc(struct ccw_device *dev, struct qdio_ssqd_desc*);
#endif /* __QDIO_H__ */ #endif /* __QDIO_H__ */
...@@ -378,6 +378,9 @@ void qdio_int_handler(struct ccw_device *cdev, unsigned long intparm, ...@@ -378,6 +378,9 @@ void qdio_int_handler(struct ccw_device *cdev, unsigned long intparm,
int qdio_allocate_qs(struct qdio_irq *irq_ptr, int nr_input_qs, int qdio_allocate_qs(struct qdio_irq *irq_ptr, int nr_input_qs,
int nr_output_qs); int nr_output_qs);
void qdio_setup_ssqd_info(struct qdio_irq *irq_ptr); void qdio_setup_ssqd_info(struct qdio_irq *irq_ptr);
int qdio_setup_get_ssqd(struct qdio_irq *irq_ptr,
struct subchannel_id *schid,
struct qdio_ssqd_desc *data);
int qdio_setup_irq(struct qdio_initialize *init_data); int qdio_setup_irq(struct qdio_initialize *init_data);
void qdio_print_subchannel_info(struct qdio_irq *irq_ptr, void qdio_print_subchannel_info(struct qdio_irq *irq_ptr,
struct ccw_device *cdev); struct ccw_device *cdev);
......
...@@ -1129,23 +1129,23 @@ void qdio_int_handler(struct ccw_device *cdev, unsigned long intparm, ...@@ -1129,23 +1129,23 @@ void qdio_int_handler(struct ccw_device *cdev, unsigned long intparm,
/** /**
* qdio_get_ssqd_desc - get qdio subchannel description * qdio_get_ssqd_desc - get qdio subchannel description
* @cdev: ccw device to get description for * @cdev: ccw device to get description for
* @data: where to store the ssqd
* *
* Returns a pointer to the saved qdio subchannel description, * Returns 0 or an error code. The results of the chsc are stored in the
* or NULL for not setup qdio devices. * specified structure.
*/ */
struct qdio_ssqd_desc *qdio_get_ssqd_desc(struct ccw_device *cdev) int qdio_get_ssqd_desc(struct ccw_device *cdev,
struct qdio_ssqd_desc *data)
{ {
struct qdio_irq *irq_ptr;
char dbf_text[15]; char dbf_text[15];
if (!cdev || !cdev->private)
return -EINVAL;
sprintf(dbf_text, "qssq%4x", cdev->private->schid.sch_no); sprintf(dbf_text, "qssq%4x", cdev->private->schid.sch_no);
QDIO_DBF_TEXT0(0, setup, dbf_text); QDIO_DBF_TEXT0(0, setup, dbf_text);
irq_ptr = cdev->private->qdio_data; return qdio_setup_get_ssqd(NULL, &cdev->private->schid, data);
if (!irq_ptr)
return NULL;
return &irq_ptr->ssqd_desc;
} }
EXPORT_SYMBOL_GPL(qdio_get_ssqd_desc); EXPORT_SYMBOL_GPL(qdio_get_ssqd_desc);
......
...@@ -243,22 +243,31 @@ static void check_and_setup_qebsm(struct qdio_irq *irq_ptr, ...@@ -243,22 +243,31 @@ static void check_and_setup_qebsm(struct qdio_irq *irq_ptr,
QDIO_DBF_TEXT0(0, setup, "noV=V"); QDIO_DBF_TEXT0(0, setup, "noV=V");
} }
static int __get_ssqd_info(struct qdio_irq *irq_ptr) /*
* If there is a qdio_irq we use the chsc_page and store the information
* in the qdio_irq, otherwise we copy it to the specified structure.
*/
int qdio_setup_get_ssqd(struct qdio_irq *irq_ptr,
struct subchannel_id *schid,
struct qdio_ssqd_desc *data)
{ {
struct chsc_ssqd_area *ssqd; struct chsc_ssqd_area *ssqd;
int rc; int rc;
QDIO_DBF_TEXT0(0, setup, "getssqd"); QDIO_DBF_TEXT0(0, setup, "getssqd");
if (irq_ptr != NULL)
ssqd = (struct chsc_ssqd_area *)irq_ptr->chsc_page; ssqd = (struct chsc_ssqd_area *)irq_ptr->chsc_page;
else
ssqd = (struct chsc_ssqd_area *)__get_free_page(GFP_KERNEL);
memset(ssqd, 0, PAGE_SIZE); memset(ssqd, 0, PAGE_SIZE);
ssqd->request = (struct chsc_header) { ssqd->request = (struct chsc_header) {
.length = 0x0010, .length = 0x0010,
.code = 0x0024, .code = 0x0024,
}; };
ssqd->first_sch = irq_ptr->schid.sch_no; ssqd->first_sch = schid->sch_no;
ssqd->last_sch = irq_ptr->schid.sch_no; ssqd->last_sch = schid->sch_no;
ssqd->ssid = irq_ptr->schid.ssid; ssqd->ssid = schid->ssid;
if (chsc(ssqd)) if (chsc(ssqd))
return -EIO; return -EIO;
...@@ -268,11 +277,17 @@ static int __get_ssqd_info(struct qdio_irq *irq_ptr) ...@@ -268,11 +277,17 @@ static int __get_ssqd_info(struct qdio_irq *irq_ptr)
if (!(ssqd->qdio_ssqd.flags & CHSC_FLAG_QDIO_CAPABILITY) || if (!(ssqd->qdio_ssqd.flags & CHSC_FLAG_QDIO_CAPABILITY) ||
!(ssqd->qdio_ssqd.flags & CHSC_FLAG_VALIDITY) || !(ssqd->qdio_ssqd.flags & CHSC_FLAG_VALIDITY) ||
(ssqd->qdio_ssqd.sch != irq_ptr->schid.sch_no)) (ssqd->qdio_ssqd.sch != schid->sch_no))
return -EINVAL; return -EINVAL;
if (irq_ptr != NULL)
memcpy(&irq_ptr->ssqd_desc, &ssqd->qdio_ssqd, memcpy(&irq_ptr->ssqd_desc, &ssqd->qdio_ssqd,
sizeof(struct qdio_ssqd_desc)); sizeof(struct qdio_ssqd_desc));
else {
memcpy(data, &ssqd->qdio_ssqd,
sizeof(struct qdio_ssqd_desc));
free_page((unsigned long)ssqd);
}
return 0; return 0;
} }
...@@ -282,7 +297,7 @@ void qdio_setup_ssqd_info(struct qdio_irq *irq_ptr) ...@@ -282,7 +297,7 @@ void qdio_setup_ssqd_info(struct qdio_irq *irq_ptr)
char dbf_text[15]; char dbf_text[15];
int rc; int rc;
rc = __get_ssqd_info(irq_ptr); rc = qdio_setup_get_ssqd(irq_ptr, &irq_ptr->schid, NULL);
if (rc) { if (rc) {
QDIO_DBF_TEXT2(0, setup, "ssqdasig"); QDIO_DBF_TEXT2(0, setup, "ssqdasig");
sprintf(dbf_text, "schn%4x", irq_ptr->schid.sch_no); sprintf(dbf_text, "schn%4x", irq_ptr->schid.sch_no);
......
...@@ -3757,7 +3757,7 @@ static int qeth_core_driver_group(const char *buf, struct device *root_dev, ...@@ -3757,7 +3757,7 @@ static int qeth_core_driver_group(const char *buf, struct device *root_dev,
int qeth_core_hardsetup_card(struct qeth_card *card) int qeth_core_hardsetup_card(struct qeth_card *card)
{ {
struct qdio_ssqd_desc *qdio_ssqd; struct qdio_ssqd_desc *ssqd;
int retries = 3; int retries = 3;
int mpno = 0; int mpno = 0;
int rc; int rc;
...@@ -3792,9 +3792,16 @@ int qeth_core_hardsetup_card(struct qeth_card *card) ...@@ -3792,9 +3792,16 @@ int qeth_core_hardsetup_card(struct qeth_card *card)
return rc; return rc;
} }
qdio_ssqd = qdio_get_ssqd_desc(CARD_DDEV(card)); ssqd = kmalloc(sizeof(struct qdio_ssqd_desc), GFP_KERNEL);
if (qdio_ssqd) if (!ssqd) {
mpno = qdio_ssqd->pcnt; rc = -ENOMEM;
goto out;
}
rc = qdio_get_ssqd_desc(CARD_DDEV(card), ssqd);
if (rc == 0)
mpno = ssqd->pcnt;
kfree(ssqd);
if (mpno) if (mpno)
mpno = min(mpno - 1, QETH_MAX_PORTNO); mpno = min(mpno - 1, QETH_MAX_PORTNO);
if (card->info.portno > mpno) { if (card->info.portno > mpno) {
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment