|
| 1 | +// SPDX-License-Identifier: GPL-2.0 |
| 2 | +/* |
| 3 | + * bsg endpoint that supports UPIUs |
| 4 | + * |
| 5 | + * Copyright (C) 2018 Western Digital Corporation |
| 6 | + */ |
| 7 | +#include "ufs_bsg.h" |
| 8 | + |
| 9 | + |
| 10 | +static int ufs_bsg_request(struct bsg_job *job) |
| 11 | +{ |
| 12 | + struct ufs_bsg_request *bsg_request = job->request; |
| 13 | + struct ufs_bsg_reply *bsg_reply = job->reply; |
| 14 | + int ret = -ENOTSUPP; |
| 15 | + |
| 16 | + bsg_reply->reply_payload_rcv_len = 0; |
| 17 | + |
| 18 | + /* Do Nothing for now */ |
| 19 | + dev_err(job->dev, "unsupported message_code 0x%x\n", |
| 20 | + bsg_request->msgcode); |
| 21 | + |
| 22 | + bsg_reply->result = ret; |
| 23 | + job->reply_len = sizeof(struct ufs_bsg_reply) + |
| 24 | + bsg_reply->reply_payload_rcv_len; |
| 25 | + |
| 26 | + bsg_job_done(job, ret, bsg_reply->reply_payload_rcv_len); |
| 27 | + |
| 28 | + return ret; |
| 29 | +} |
| 30 | + |
| 31 | +/** |
| 32 | + * ufs_bsg_remove - detach and remove the added ufs-bsg node |
| 33 | + * |
| 34 | + * Should be called when unloading the driver. |
| 35 | + */ |
| 36 | +void ufs_bsg_remove(struct ufs_hba *hba) |
| 37 | +{ |
| 38 | + struct device *bsg_dev = &hba->bsg_dev; |
| 39 | + |
| 40 | + if (!hba->bsg_queue) |
| 41 | + return; |
| 42 | + |
| 43 | + bsg_unregister_queue(hba->bsg_queue); |
| 44 | + |
| 45 | + device_del(bsg_dev); |
| 46 | + put_device(bsg_dev); |
| 47 | +} |
| 48 | + |
| 49 | +static inline void ufs_bsg_node_release(struct device *dev) |
| 50 | +{ |
| 51 | + put_device(dev->parent); |
| 52 | +} |
| 53 | + |
| 54 | +/** |
| 55 | + * ufs_bsg_probe - Add ufs bsg device node |
| 56 | + * @hba: per adapter object |
| 57 | + * |
| 58 | + * Called during initial loading of the driver, and before scsi_scan_host. |
| 59 | + */ |
| 60 | +int ufs_bsg_probe(struct ufs_hba *hba) |
| 61 | +{ |
| 62 | + struct device *bsg_dev = &hba->bsg_dev; |
| 63 | + struct Scsi_Host *shost = hba->host; |
| 64 | + struct device *parent = &shost->shost_gendev; |
| 65 | + struct request_queue *q; |
| 66 | + int ret; |
| 67 | + |
| 68 | + device_initialize(bsg_dev); |
| 69 | + |
| 70 | + bsg_dev->parent = get_device(parent); |
| 71 | + bsg_dev->release = ufs_bsg_node_release; |
| 72 | + |
| 73 | + dev_set_name(bsg_dev, "ufs-bsg"); |
| 74 | + |
| 75 | + ret = device_add(bsg_dev); |
| 76 | + if (ret) |
| 77 | + goto out; |
| 78 | + |
| 79 | + q = bsg_setup_queue(bsg_dev, dev_name(bsg_dev), ufs_bsg_request, 0); |
| 80 | + if (IS_ERR(q)) { |
| 81 | + ret = PTR_ERR(q); |
| 82 | + goto out; |
| 83 | + } |
| 84 | + |
| 85 | + hba->bsg_queue = q; |
| 86 | + |
| 87 | + return 0; |
| 88 | + |
| 89 | +out: |
| 90 | + dev_err(bsg_dev, "fail to initialize a bsg dev %d\n", shost->host_no); |
| 91 | + put_device(bsg_dev); |
| 92 | + return ret; |
| 93 | +} |
0 commit comments