Some hardware handler might prefer to queue the commands to the controller so as not to flood the controller with commands. This patch implements a generic workqueue framework for hardware handler and converts dm-mpath-rdac to use it. Signed-off-by: Hannes Reinecke <hare@xxxxxxx> --- drivers/md/dm-hw-handler.c | 88 ++++++++++++++++++++++++++++++++++++++- drivers/md/dm-hw-handler.h | 14 ++++++ drivers/md/dm-mpath-rdac.c | 99 ++++++++++++++++++++++---------------------- drivers/md/dm-mpath.c | 7 ++- 4 files changed, 153 insertions(+), 55 deletions(-) diff --git a/drivers/md/dm-hw-handler.c b/drivers/md/dm-hw-handler.c index 2ee84d8..1d02c6a 100644 --- a/drivers/md/dm-hw-handler.c +++ b/drivers/md/dm-hw-handler.c @@ -11,10 +11,14 @@ #include <linux/slab.h> +#define DM_MSG_PREFIX "multipath hwh" + struct hwh_internal { struct hw_handler_type hwht; struct list_head list; + struct workqueue_struct *workq; + char *workq_name; long use; }; @@ -99,6 +103,24 @@ static struct hwh_internal *_alloc_hw_handler(struct hw_handler_type *hwht) return hwhi; } +static int _alloc_hw_workq(struct hwh_internal *hwhi, + struct hw_handler_type *hwht) +{ + int r = 0; + + hwhi->workq_name = kzalloc(strlen(hwht->name) + 6, GFP_KERNEL); + if (!hwhi->workq_name) + return -ENOMEM; + + sprintf(hwhi->workq_name, "%s_wkqd", hwht->name); + hwhi->workq = create_singlethread_workqueue(hwhi->workq_name); + + if (!hwhi->workq) + r = -EEXIST; + + return r; +} + int dm_register_hw_handler(struct hw_handler_type *hwht) { int r = 0; @@ -112,9 +134,13 @@ int dm_register_hw_handler(struct hw_handler_type *hwht) if (__find_hw_handler_type(hwht->name)) { kfree(hwhi); r = -EEXIST; - } else - list_add(&hwhi->list, &_hw_handlers); + } else { + if (hwht->workq_fn) + r = _alloc_hw_workq(hwhi, hwht); + if (!r) + list_add(&hwhi->list, &_hw_handlers); + } up_write(&_hwh_lock); return r; @@ -141,11 +167,68 @@ int dm_unregister_hw_handler(struct hw_handler_type *hwht) up_write(&_hwh_lock); + if (hwhi->workq) { + destroy_workqueue(hwhi->workq); + kfree(hwhi->workq_name); + } + kfree(hwhi); return 0; } +static void dm_service_hw_workq(struct work_struct *work) +{ + struct hw_handler *hwh = container_of(work, struct hw_handler, work); + struct hw_handler_type *hwht = hwh->type; + struct hwh_internal *hwhi = container_of(hwht, struct hwh_internal, hwht); + + if (hwht->workq_fn) + hwht->workq_fn(hwh); + +} + +int dm_create_hw_handler(struct hw_handler *hwh, unsigned int argc, + char **argv) +{ + struct hw_handler_type *hwht = hwh->type; + int r; + + r = hwht->create(hwh, argc, argv); + if (r) + return r; + + if (hwht->workq_fn) { + INIT_WORK(&hwh->work, dm_service_hw_workq); + } + + return 0; +} + +void dm_destroy_hw_handler(struct hw_handler *hwh) +{ + struct hw_handler_type *hwht = hwh->type; + + hwht->destroy(hwh); +} + +void dm_enqueue_hw_workq(struct hw_handler *hwh) +{ + struct hw_handler_type *hwht = hwh->type; + struct hwh_internal *hwhi = container_of(hwht, struct hwh_internal, hwht); + + down_read(&_hwh_lock); + if (!hwhi->workq) + goto out; + + DMWARN("submit %s request", hwh->type->name); + queue_work(hwhi->workq, &hwh->work); + + out: + up_read(&_hwh_lock); + return; +} + unsigned dm_scsi_err_handler(struct hw_handler *hwh, struct bio *bio) { #if 0 @@ -210,4 +293,5 @@ unsigned dm_scsi_err_handler(struct hw_handler *hwh, struct bio *bio) EXPORT_SYMBOL_GPL(dm_register_hw_handler); EXPORT_SYMBOL_GPL(dm_unregister_hw_handler); +EXPORT_SYMBOL_GPL(dm_enqueue_hw_workq); EXPORT_SYMBOL_GPL(dm_scsi_err_handler); diff --git a/drivers/md/dm-hw-handler.h b/drivers/md/dm-hw-handler.h index 46809dc..9216682 100644 --- a/drivers/md/dm-hw-handler.h +++ b/drivers/md/dm-hw-handler.h @@ -14,9 +14,12 @@ #include "dm-mpath.h" struct hw_handler_type; + struct hw_handler { + struct list_head entry; struct hw_handler_type *type; struct mapped_device *md; + struct work_struct work; void *context; }; @@ -37,6 +40,7 @@ struct hw_handler_type { unsigned (*error) (struct hw_handler *hwh, struct bio *bio); int (*status) (struct hw_handler *hwh, status_type_t type, char *result, unsigned int maxlen); + void (*workq_fn) (struct hw_handler *hwh); }; /* Register a hardware handler */ @@ -51,6 +55,16 @@ struct hw_handler_type *dm_get_hw_handler(const char *name); /* Releases a hardware handler */ void dm_put_hw_handler(struct hw_handler_type *hwht); +/* Creates a hardware handler */ +int dm_create_hw_handler(struct hw_handler *handler, unsigned int argc, + char **argv); + +/* Destroys a hardware handler */ +void dm_destroy_hw_handler(struct hw_handler *handler); + +/* Enqueue an element to the workqueue */ +void dm_enqueue_hw_workq(struct hw_handler *hwh); + /* Default err function */ unsigned dm_scsi_err_handler(struct hw_handler *hwh, struct bio *bio); diff --git a/drivers/md/dm-mpath-rdac.c b/drivers/md/dm-mpath-rdac.c index e04eb5c..99f755c 100644 --- a/drivers/md/dm-mpath-rdac.c +++ b/drivers/md/dm-mpath-rdac.c @@ -176,14 +176,12 @@ struct c2_inquiry { }; struct rdac_handler { - struct list_head entry; /* list waiting to submit MODE SELECT */ unsigned timeout; struct rdac_controller *ctlr; #define UNINITIALIZED_LUN (1 << 8) unsigned lun; unsigned char sense[SCSI_SENSE_BUFFERSIZE]; struct dm_path *path; - struct work_struct work; #define SEND_C2_INQUIRY 1 #define SEND_C4_INQUIRY 2 #define SEND_C8_INQUIRY 3 @@ -200,7 +198,6 @@ struct rdac_handler { static LIST_HEAD(ctlr_list); static DEFINE_SPINLOCK(list_lock); -static struct workqueue_struct *rdac_wkqd; static inline int had_failures(struct request *req, int error) { @@ -208,15 +205,16 @@ static inline int had_failures(struct request *req, int error) msg_byte(req->errors) != COMMAND_COMPLETE); } -static void rdac_resubmit_all(struct rdac_handler *h) +static void rdac_resubmit_all(struct rdac_controller *ctlr) { - struct rdac_controller *ctlr = h->ctlr; - struct rdac_handler *tmp, *h1; + struct rdac_handler *h; + struct hw_handler *tmp, *h1; spin_lock(&ctlr->lock); list_for_each_entry_safe(h1, tmp, &ctlr->cmd_list, entry) { - h1->cmd_to_send = SEND_C9_INQUIRY; - queue_work(rdac_wkqd, &h1->work); + h = h1->context; + h->cmd_to_send = SEND_C9_INQUIRY; + dm_enqueue_hw_workq(h1); list_del(&h1->entry); } ctlr->submitted = 0; @@ -225,7 +223,8 @@ static void rdac_resubmit_all(struct rdac_handler *h) static void mode_select_endio(struct request *req, int error) { - struct rdac_handler *h = req->end_io_data; + struct hw_handler *hwh = req->end_io_data; + struct rdac_handler *h = hwh->context; struct scsi_sense_hdr sense_hdr; int sense = 0, fail = 0; @@ -247,13 +246,13 @@ static void mode_select_endio(struct request *req, int error) * 0x62900 - Power On, Reset, or Bus Device Reset */ h->cmd_to_send = SEND_C9_INQUIRY; - queue_work(rdac_wkqd, &h->work); + dm_enqueue_hw_workq(hwh); goto done; } if (sense) DMINFO("MODE_SELECT failed on %s with sense 0x%x", h->path->dev->name, sense); - } + } failed: if (fail || sense) dm_pg_init_complete(h->path, MP_FAIL_PATH); @@ -261,13 +260,14 @@ failed: dm_pg_init_complete(h->path, 0); done: - rdac_resubmit_all(h); + rdac_resubmit_all(h->ctlr); __blk_put_request(req->q, req); } -static struct request *get_rdac_req(struct rdac_handler *h, +static struct request *get_rdac_req(struct hw_handler *hwh, void *buffer, unsigned buflen, int rw) { + struct rdac_handler *h = hwh->context; struct request *rq; struct request_queue *q = bdev_get_queue(h->path->dev->bdev); @@ -284,20 +284,21 @@ static struct request *get_rdac_req(struct rdac_handler *h, return NULL; } - memset(&rq->cmd, 0, BLK_MAX_CDB); + memset(&rq->cmd, 0, BLK_MAX_CDB); rq->sense = h->sense; memset(rq->sense, 0, SCSI_SENSE_BUFFERSIZE); rq->sense_len = 0; - rq->end_io_data = h; + rq->end_io_data = hwh; rq->timeout = h->timeout; rq->cmd_type = REQ_TYPE_BLOCK_PC; rq->cmd_flags |= REQ_FAILFAST | REQ_NOMERGE; return rq; } -static struct request *rdac_failover_get(struct rdac_handler *h) +static struct request *rdac_failover_get(struct hw_handler *hwh) { + struct rdac_handler *h = hwh->context; struct request *rq; struct rdac_mode_common *common; unsigned data_size; @@ -330,7 +331,7 @@ static struct request *rdac_failover_get(struct rdac_handler *h) common->rdac_options = RDAC_FORCED_QUIESENCE; /* get request for block layer packet command */ - rq = get_rdac_req(h, &h->ctlr->mode_select, data_size, WRITE); + rq = get_rdac_req(hwh, &h->ctlr->mode_select, data_size, WRITE); if (!rq) { DMERR("rdac_failover_get: no rq"); return NULL; @@ -351,14 +352,15 @@ static struct request *rdac_failover_get(struct rdac_handler *h) } /* Acquires h->ctlr->lock */ -static void submit_mode_select(struct rdac_handler *h) +static void submit_mode_select(struct hw_handler *hwh) { + struct rdac_handler *h = hwh->context; struct request *rq; struct request_queue *q = bdev_get_queue(h->path->dev->bdev); spin_lock(&h->ctlr->lock); if (h->ctlr->submitted) { - list_add(&h->entry, &h->ctlr->cmd_list); + list_add(&hwh->entry, &h->ctlr->cmd_list); goto drop_lock; } @@ -367,13 +369,13 @@ static void submit_mode_select(struct rdac_handler *h) goto fail_path; } - rq = rdac_failover_get(h); + rq = rdac_failover_get(hwh); if (!rq) { DMERR("submit_mode_select: no rq"); goto fail_path; } - DMINFO("queueing MODE_SELECT command on %s", h->path->dev->name); + DMINFO("submit MODE_SELECT command on %s", h->path->dev->name); blk_execute_rq_nowait(q, NULL, rq, 1, mode_select_endio); h->ctlr->submitted = 1; @@ -429,7 +431,8 @@ done: static void c4_endio(struct request *req, int error) { - struct rdac_handler *h = req->end_io_data; + struct hw_handler *hwh = req->end_io_data; + struct rdac_handler *h = hwh->context; struct c4_inquiry *sp; if (had_failures(req, error)) { @@ -443,7 +446,7 @@ static void c4_endio(struct request *req, int error) if (h->ctlr) { h->cmd_to_send = SEND_C9_INQUIRY; - queue_work(rdac_wkqd, &h->work); + dm_enqueue_hw_workq(hwh); } else dm_pg_init_complete(h->path, MP_FAIL_PATH); done: @@ -452,7 +455,8 @@ done: static void c2_endio(struct request *req, int error) { - struct rdac_handler *h = req->end_io_data; + struct hw_handler *hwh = req->end_io_data; + struct rdac_handler *h = hwh->context; struct c2_inquiry *sp; if (had_failures(req, error)) { @@ -469,14 +473,15 @@ static void c2_endio(struct request *req, int error) h->ctlr->use_10_ms = 0; h->cmd_to_send = SEND_MODE_SELECT; - queue_work(rdac_wkqd, &h->work); + dm_enqueue_hw_workq(hwh); done: __blk_put_request(req->q, req); } static void c9_endio(struct request *req, int error) { - struct rdac_handler *h = req->end_io_data; + struct hw_handler *hwh = req->end_io_data; + struct rdac_handler *h = hwh->context; struct c9_inquiry *sp; if (had_failures(req, error)) { @@ -510,14 +515,15 @@ static void c9_endio(struct request *req, int error) h->cmd_to_send = SEND_MODE_SELECT; } else h->cmd_to_send = SEND_C4_INQUIRY; - queue_work(rdac_wkqd, &h->work); + dm_enqueue_hw_workq(hwh); done: __blk_put_request(req->q, req); } static void c8_endio(struct request *req, int error) { - struct rdac_handler *h = req->end_io_data; + struct hw_handler *hwh = req->end_io_data; + struct rdac_handler *h = hwh->context; struct c8_inquiry *sp; if (had_failures(req, error)) { @@ -531,21 +537,22 @@ static void c8_endio(struct request *req, int error) sp = &h->inq.c8; h->lun = sp->lun[7]; /* currently it uses only one byte */ h->cmd_to_send = SEND_C9_INQUIRY; - queue_work(rdac_wkqd, &h->work); + dm_enqueue_hw_workq(hwh); done: __blk_put_request(req->q, req); } -static void submit_inquiry(struct rdac_handler *h, int page_code, +static void submit_inquiry(struct hw_handler *hwh, int page_code, unsigned int len, rq_end_io_fn endio) { + struct rdac_handler *h = hwh->context; struct request *rq; struct request_queue *q = bdev_get_queue(h->path->dev->bdev); if (!q) goto fail_path; - rq = get_rdac_req(h, &h->inq, len, READ); + rq = get_rdac_req(hwh, &h->inq, len, READ); if (!rq) goto fail_path; @@ -562,25 +569,25 @@ fail_path: dm_pg_init_complete(h->path, MP_FAIL_PATH); } -static void service_wkq(struct work_struct *work) +static void rdac_service_wkq(struct hw_handler *hwh) { - struct rdac_handler *h = container_of(work, struct rdac_handler, work); + struct rdac_handler *h = hwh->context; switch (h->cmd_to_send) { case SEND_C2_INQUIRY: - submit_inquiry(h, 0xC2, sizeof(struct c2_inquiry), c2_endio); + submit_inquiry(hwh, 0xC2, sizeof(struct c2_inquiry), c2_endio); break; case SEND_C4_INQUIRY: - submit_inquiry(h, 0xC4, sizeof(struct c4_inquiry), c4_endio); + submit_inquiry(hwh, 0xC4, sizeof(struct c4_inquiry), c4_endio); break; case SEND_C8_INQUIRY: - submit_inquiry(h, 0xC8, sizeof(struct c8_inquiry), c8_endio); + submit_inquiry(hwh, 0xC8, sizeof(struct c8_inquiry), c8_endio); break; case SEND_C9_INQUIRY: - submit_inquiry(h, 0xC9, sizeof(struct c9_inquiry), c9_endio); + submit_inquiry(hwh, 0xC9, sizeof(struct c9_inquiry), c9_endio); break; case SEND_MODE_SELECT: - submit_mode_select(h); + submit_mode_select(hwh); break; default: BUG(); @@ -603,7 +610,7 @@ static int rdac_create(struct hw_handler *hwh, unsigned argc, char **argv) DMWARN("incorrect number of arguments"); return -EINVAL; } else { - if (sscanf(argv[1], "%u", &timeout) != 1) { + if (sscanf(argv[0], "%u", &timeout) != 1) { DMWARN("invalid timeout value"); return -EINVAL; } @@ -616,7 +623,6 @@ static int rdac_create(struct hw_handler *hwh, unsigned argc, char **argv) hwh->context = h; h->timeout = timeout; h->lun = UNINITIALIZED_LUN; - INIT_WORK(&h->work, service_wkq); DMWARN("using RDAC command with timeout %u", h->timeout); return 0; @@ -646,10 +652,10 @@ static void rdac_pg_init(struct hw_handler *hwh, unsigned bypassed, h->path = path; switch (h->lun) { case UNINITIALIZED_LUN: - submit_inquiry(h, 0xC8, sizeof(struct c8_inquiry), c8_endio); + submit_inquiry(hwh, 0xC8, sizeof(struct c8_inquiry), c8_endio); break; default: - submit_inquiry(h, 0xC9, sizeof(struct c9_inquiry), c9_endio); + submit_inquiry(hwh, 0xC9, sizeof(struct c9_inquiry), c9_endio); } } @@ -660,22 +666,16 @@ static struct hw_handler_type rdac_handler = { .destroy = rdac_destroy, .pg_init = rdac_pg_init, .error = rdac_error, + .workq_fn = rdac_service_wkq, }; static int __init rdac_init(void) { int r; - rdac_wkqd = create_singlethread_workqueue("rdac_wkqd"); - if (!rdac_wkqd) { - DMERR("Failed to create workqueue rdac_wkqd."); - return -ENOMEM; - } - r = dm_register_hw_handler(&rdac_handler); if (r < 0) { DMERR("%s: register failed %d", RDAC_DM_HWH_NAME, r); - destroy_workqueue(rdac_wkqd); return r; } @@ -687,7 +687,6 @@ static void __exit rdac_exit(void) { int r = dm_unregister_hw_handler(&rdac_handler); - destroy_workqueue(rdac_wkqd); if (r < 0) DMERR("%s: unregister failed %d", RDAC_DM_HWH_NAME, r); } diff --git a/drivers/md/dm-mpath.c b/drivers/md/dm-mpath.c index 24b2b1e..65a52b7 100644 --- a/drivers/md/dm-mpath.c +++ b/drivers/md/dm-mpath.c @@ -201,7 +201,7 @@ static void free_multipath(struct multipath *m) } if (hwh->type) { - hwh->type->destroy(hwh); + dm_destroy_hw_handler(hwh); dm_put_hw_handler(hwh->type); } @@ -677,14 +677,15 @@ static int parse_hw_handler(struct arg_set *as, struct multipath *m) m->hw_handler.md = dm_table_get_md(ti->table); dm_put(m->hw_handler.md); - r = hwht->create(&m->hw_handler, hw_argc - 1, as->argv); + m->hw_handler.type = hwht; + + r = dm_create_hw_handler(&m->hw_handler, hw_argc - 1, as->argv); if (r) { dm_put_hw_handler(hwht); ti->error = "hardware handler constructor failed"; return r; } - m->hw_handler.type = hwht; consume(as, hw_argc - 1); return 0; -- 1.5.3.2 -- dm-devel mailing list dm-devel@xxxxxxxxxx https://www.redhat.com/mailman/listinfo/dm-devel