ibmvstgt.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960
  1. /*
  2. * IBM eServer i/pSeries Virtual SCSI Target Driver
  3. * Copyright (C) 2003-2005 Dave Boutcher (boutcher@us.ibm.com) IBM Corp.
  4. * Santiago Leon (santil@us.ibm.com) IBM Corp.
  5. * Linda Xie (lxie@us.ibm.com) IBM Corp.
  6. *
  7. * Copyright (C) 2005-2006 FUJITA Tomonori <tomof@acm.org>
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2 of the License, or
  12. * (at your option) any later version.
  13. *
  14. * This program is distributed in the hope that it will be useful,
  15. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17. * GNU General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
  22. * USA
  23. */
  24. #include <linux/interrupt.h>
  25. #include <linux/module.h>
  26. #include <scsi/scsi.h>
  27. #include <scsi/scsi_host.h>
  28. #include <scsi/scsi_tgt.h>
  29. #include <scsi/libsrp.h>
  30. #include <asm/hvcall.h>
  31. #include <asm/iommu.h>
  32. #include <asm/prom.h>
  33. #include <asm/vio.h>
  34. #include "ibmvscsi.h"
  35. #define INITIAL_SRP_LIMIT 16
  36. #define DEFAULT_MAX_SECTORS 512
  37. #define TGT_NAME "ibmvstgt"
  38. /*
  39. * Hypervisor calls.
  40. */
  41. #define h_copy_rdma(l, sa, sb, da, db) \
  42. plpar_hcall_norets(H_COPY_RDMA, l, sa, sb, da, db)
  43. #define h_send_crq(ua, l, h) \
  44. plpar_hcall_norets(H_SEND_CRQ, ua, l, h)
  45. #define h_reg_crq(ua, tok, sz)\
  46. plpar_hcall_norets(H_REG_CRQ, ua, tok, sz);
  47. #define h_free_crq(ua) \
  48. plpar_hcall_norets(H_FREE_CRQ, ua);
  49. /* tmp - will replace with SCSI logging stuff */
  50. #define eprintk(fmt, args...) \
  51. do { \
  52. printk("%s(%d) " fmt, __FUNCTION__, __LINE__, ##args); \
  53. } while (0)
  54. /* #define dprintk eprintk */
  55. #define dprintk(fmt, args...)
  56. struct vio_port {
  57. struct vio_dev *dma_dev;
  58. struct crq_queue crq_queue;
  59. struct work_struct crq_work;
  60. unsigned long liobn;
  61. unsigned long riobn;
  62. struct srp_target *target;
  63. };
  64. static struct workqueue_struct *vtgtd;
  65. /*
  66. * These are fixed for the system and come from the Open Firmware device tree.
  67. * We just store them here to save getting them every time.
  68. */
  69. static char system_id[64] = "";
  70. static char partition_name[97] = "UNKNOWN";
  71. static unsigned int partition_number = -1;
  72. static struct vio_port *target_to_port(struct srp_target *target)
  73. {
  74. return (struct vio_port *) target->ldata;
  75. }
  76. static inline union viosrp_iu *vio_iu(struct iu_entry *iue)
  77. {
  78. return (union viosrp_iu *) (iue->sbuf->buf);
  79. }
  80. static int send_iu(struct iu_entry *iue, uint64_t length, uint8_t format)
  81. {
  82. struct srp_target *target = iue->target;
  83. struct vio_port *vport = target_to_port(target);
  84. long rc, rc1;
  85. union {
  86. struct viosrp_crq cooked;
  87. uint64_t raw[2];
  88. } crq;
  89. /* First copy the SRP */
  90. rc = h_copy_rdma(length, vport->liobn, iue->sbuf->dma,
  91. vport->riobn, iue->remote_token);
  92. if (rc)
  93. eprintk("Error %ld transferring data\n", rc);
  94. crq.cooked.valid = 0x80;
  95. crq.cooked.format = format;
  96. crq.cooked.reserved = 0x00;
  97. crq.cooked.timeout = 0x00;
  98. crq.cooked.IU_length = length;
  99. crq.cooked.IU_data_ptr = vio_iu(iue)->srp.rsp.tag;
  100. if (rc == 0)
  101. crq.cooked.status = 0x99; /* Just needs to be non-zero */
  102. else
  103. crq.cooked.status = 0x00;
  104. rc1 = h_send_crq(vport->dma_dev->unit_address, crq.raw[0], crq.raw[1]);
  105. if (rc1) {
  106. eprintk("%ld sending response\n", rc1);
  107. return rc1;
  108. }
  109. return rc;
  110. }
  111. #define SRP_RSP_SENSE_DATA_LEN 18
  112. static int send_rsp(struct iu_entry *iue, struct scsi_cmnd *sc,
  113. unsigned char status, unsigned char asc)
  114. {
  115. union viosrp_iu *iu = vio_iu(iue);
  116. uint64_t tag = iu->srp.rsp.tag;
  117. /* If the linked bit is on and status is good */
  118. if (test_bit(V_LINKED, &iue->flags) && (status == NO_SENSE))
  119. status = 0x10;
  120. memset(iu, 0, sizeof(struct srp_rsp));
  121. iu->srp.rsp.opcode = SRP_RSP;
  122. iu->srp.rsp.req_lim_delta = 1;
  123. iu->srp.rsp.tag = tag;
  124. if (test_bit(V_DIOVER, &iue->flags))
  125. iu->srp.rsp.flags |= SRP_RSP_FLAG_DIOVER;
  126. iu->srp.rsp.data_in_res_cnt = 0;
  127. iu->srp.rsp.data_out_res_cnt = 0;
  128. iu->srp.rsp.flags &= ~SRP_RSP_FLAG_RSPVALID;
  129. iu->srp.rsp.resp_data_len = 0;
  130. iu->srp.rsp.status = status;
  131. if (status) {
  132. uint8_t *sense = iu->srp.rsp.data;
  133. if (sc) {
  134. iu->srp.rsp.flags |= SRP_RSP_FLAG_SNSVALID;
  135. iu->srp.rsp.sense_data_len = SCSI_SENSE_BUFFERSIZE;
  136. memcpy(sense, sc->sense_buffer, SCSI_SENSE_BUFFERSIZE);
  137. } else {
  138. iu->srp.rsp.status = SAM_STAT_CHECK_CONDITION;
  139. iu->srp.rsp.flags |= SRP_RSP_FLAG_SNSVALID;
  140. iu->srp.rsp.sense_data_len = SRP_RSP_SENSE_DATA_LEN;
  141. /* Valid bit and 'current errors' */
  142. sense[0] = (0x1 << 7 | 0x70);
  143. /* Sense key */
  144. sense[2] = status;
  145. /* Additional sense length */
  146. sense[7] = 0xa; /* 10 bytes */
  147. /* Additional sense code */
  148. sense[12] = asc;
  149. }
  150. }
  151. send_iu(iue, sizeof(iu->srp.rsp) + SRP_RSP_SENSE_DATA_LEN,
  152. VIOSRP_SRP_FORMAT);
  153. return 0;
  154. }
  155. static void handle_cmd_queue(struct srp_target *target)
  156. {
  157. struct Scsi_Host *shost = target->shost;
  158. struct iu_entry *iue;
  159. struct srp_cmd *cmd;
  160. unsigned long flags;
  161. int err;
  162. retry:
  163. spin_lock_irqsave(&target->lock, flags);
  164. list_for_each_entry(iue, &target->cmd_queue, ilist) {
  165. if (!test_and_set_bit(V_FLYING, &iue->flags)) {
  166. spin_unlock_irqrestore(&target->lock, flags);
  167. cmd = iue->sbuf->buf;
  168. err = srp_cmd_queue(shost, cmd, iue, 0);
  169. if (err) {
  170. eprintk("cannot queue cmd %p %d\n", cmd, err);
  171. srp_iu_put(iue);
  172. }
  173. goto retry;
  174. }
  175. }
  176. spin_unlock_irqrestore(&target->lock, flags);
  177. }
  178. static int ibmvstgt_rdma(struct scsi_cmnd *sc, struct scatterlist *sg, int nsg,
  179. struct srp_direct_buf *md, int nmd,
  180. enum dma_data_direction dir, unsigned int rest)
  181. {
  182. struct iu_entry *iue = (struct iu_entry *) sc->SCp.ptr;
  183. struct srp_target *target = iue->target;
  184. struct vio_port *vport = target_to_port(target);
  185. dma_addr_t token;
  186. long err;
  187. unsigned int done = 0;
  188. int i, sidx, soff;
  189. sidx = soff = 0;
  190. token = sg_dma_address(sg + sidx);
  191. for (i = 0; i < nmd && rest; i++) {
  192. unsigned int mdone, mlen;
  193. mlen = min(rest, md[i].len);
  194. for (mdone = 0; mlen;) {
  195. int slen = min(sg_dma_len(sg + sidx) - soff, mlen);
  196. if (dir == DMA_TO_DEVICE)
  197. err = h_copy_rdma(slen,
  198. vport->riobn,
  199. md[i].va + mdone,
  200. vport->liobn,
  201. token + soff);
  202. else
  203. err = h_copy_rdma(slen,
  204. vport->liobn,
  205. token + soff,
  206. vport->riobn,
  207. md[i].va + mdone);
  208. if (err != H_SUCCESS) {
  209. eprintk("rdma error %d %d\n", dir, slen);
  210. goto out;
  211. }
  212. mlen -= slen;
  213. mdone += slen;
  214. soff += slen;
  215. done += slen;
  216. if (soff == sg_dma_len(sg + sidx)) {
  217. sidx++;
  218. soff = 0;
  219. token = sg_dma_address(sg + sidx);
  220. if (sidx > nsg) {
  221. eprintk("out of sg %p %d %d\n",
  222. iue, sidx, nsg);
  223. goto out;
  224. }
  225. }
  226. };
  227. rest -= mlen;
  228. }
  229. out:
  230. return 0;
  231. }
  232. static int ibmvstgt_transfer_data(struct scsi_cmnd *sc,
  233. void (*done)(struct scsi_cmnd *))
  234. {
  235. struct iu_entry *iue = (struct iu_entry *) sc->SCp.ptr;
  236. int err;
  237. err = srp_transfer_data(sc, &vio_iu(iue)->srp.cmd, ibmvstgt_rdma, 1, 1);
  238. done(sc);
  239. return err;
  240. }
  241. static int ibmvstgt_cmd_done(struct scsi_cmnd *sc,
  242. void (*done)(struct scsi_cmnd *))
  243. {
  244. unsigned long flags;
  245. struct iu_entry *iue = (struct iu_entry *) sc->SCp.ptr;
  246. struct srp_target *target = iue->target;
  247. dprintk("%p %p %x\n", iue, target, vio_iu(iue)->srp.cmd.cdb[0]);
  248. spin_lock_irqsave(&target->lock, flags);
  249. list_del(&iue->ilist);
  250. spin_unlock_irqrestore(&target->lock, flags);
  251. if (sc->result != SAM_STAT_GOOD) {
  252. eprintk("operation failed %p %d %x\n",
  253. iue, sc->result, vio_iu(iue)->srp.cmd.cdb[0]);
  254. send_rsp(iue, sc, HARDWARE_ERROR, 0x00);
  255. } else
  256. send_rsp(iue, sc, NO_SENSE, 0x00);
  257. done(sc);
  258. srp_iu_put(iue);
  259. return 0;
  260. }
  261. int send_adapter_info(struct iu_entry *iue,
  262. dma_addr_t remote_buffer, uint16_t length)
  263. {
  264. struct srp_target *target = iue->target;
  265. struct vio_port *vport = target_to_port(target);
  266. struct Scsi_Host *shost = target->shost;
  267. dma_addr_t data_token;
  268. struct mad_adapter_info_data *info;
  269. int err;
  270. info = dma_alloc_coherent(target->dev, sizeof(*info), &data_token,
  271. GFP_KERNEL);
  272. if (!info) {
  273. eprintk("bad dma_alloc_coherent %p\n", target);
  274. return 1;
  275. }
  276. /* Get remote info */
  277. err = h_copy_rdma(sizeof(*info), vport->riobn, remote_buffer,
  278. vport->liobn, data_token);
  279. if (err == H_SUCCESS) {
  280. dprintk("Client connect: %s (%d)\n",
  281. info->partition_name, info->partition_number);
  282. }
  283. memset(info, 0, sizeof(*info));
  284. strcpy(info->srp_version, "16.a");
  285. strncpy(info->partition_name, partition_name,
  286. sizeof(info->partition_name));
  287. info->partition_number = partition_number;
  288. info->mad_version = 1;
  289. info->os_type = 2;
  290. info->port_max_txu[0] = shost->hostt->max_sectors << 9;
  291. /* Send our info to remote */
  292. err = h_copy_rdma(sizeof(*info), vport->liobn, data_token,
  293. vport->riobn, remote_buffer);
  294. dma_free_coherent(target->dev, sizeof(*info), info, data_token);
  295. if (err != H_SUCCESS) {
  296. eprintk("Error sending adapter info %d\n", err);
  297. return 1;
  298. }
  299. return 0;
  300. }
  301. static void process_login(struct iu_entry *iue)
  302. {
  303. union viosrp_iu *iu = vio_iu(iue);
  304. struct srp_login_rsp *rsp = &iu->srp.login_rsp;
  305. uint64_t tag = iu->srp.rsp.tag;
  306. /* TODO handle case that requested size is wrong and
  307. * buffer format is wrong
  308. */
  309. memset(iu, 0, sizeof(struct srp_login_rsp));
  310. rsp->opcode = SRP_LOGIN_RSP;
  311. rsp->req_lim_delta = INITIAL_SRP_LIMIT;
  312. rsp->tag = tag;
  313. rsp->max_it_iu_len = sizeof(union srp_iu);
  314. rsp->max_ti_iu_len = sizeof(union srp_iu);
  315. /* direct and indirect */
  316. rsp->buf_fmt = SRP_BUF_FORMAT_DIRECT | SRP_BUF_FORMAT_INDIRECT;
  317. send_iu(iue, sizeof(*rsp), VIOSRP_SRP_FORMAT);
  318. }
  319. static inline void queue_cmd(struct iu_entry *iue)
  320. {
  321. struct srp_target *target = iue->target;
  322. unsigned long flags;
  323. spin_lock_irqsave(&target->lock, flags);
  324. list_add_tail(&iue->ilist, &target->cmd_queue);
  325. spin_unlock_irqrestore(&target->lock, flags);
  326. }
  327. static int process_tsk_mgmt(struct iu_entry *iue)
  328. {
  329. union viosrp_iu *iu = vio_iu(iue);
  330. int fn;
  331. dprintk("%p %u\n", iue, iu->srp.tsk_mgmt.tsk_mgmt_func);
  332. switch (iu->srp.tsk_mgmt.tsk_mgmt_func) {
  333. case SRP_TSK_ABORT_TASK:
  334. fn = ABORT_TASK;
  335. break;
  336. case SRP_TSK_ABORT_TASK_SET:
  337. fn = ABORT_TASK_SET;
  338. break;
  339. case SRP_TSK_CLEAR_TASK_SET:
  340. fn = CLEAR_TASK_SET;
  341. break;
  342. case SRP_TSK_LUN_RESET:
  343. fn = LOGICAL_UNIT_RESET;
  344. break;
  345. case SRP_TSK_CLEAR_ACA:
  346. fn = CLEAR_ACA;
  347. break;
  348. default:
  349. fn = 0;
  350. }
  351. if (fn)
  352. scsi_tgt_tsk_mgmt_request(iue->target->shost, fn,
  353. iu->srp.tsk_mgmt.task_tag,
  354. (struct scsi_lun *) &iu->srp.tsk_mgmt.lun,
  355. iue);
  356. else
  357. send_rsp(iue, NULL, ILLEGAL_REQUEST, 0x20);
  358. return !fn;
  359. }
  360. static int process_mad_iu(struct iu_entry *iue)
  361. {
  362. union viosrp_iu *iu = vio_iu(iue);
  363. struct viosrp_adapter_info *info;
  364. struct viosrp_host_config *conf;
  365. switch (iu->mad.empty_iu.common.type) {
  366. case VIOSRP_EMPTY_IU_TYPE:
  367. eprintk("%s\n", "Unsupported EMPTY MAD IU");
  368. break;
  369. case VIOSRP_ERROR_LOG_TYPE:
  370. eprintk("%s\n", "Unsupported ERROR LOG MAD IU");
  371. iu->mad.error_log.common.status = 1;
  372. send_iu(iue, sizeof(iu->mad.error_log), VIOSRP_MAD_FORMAT);
  373. break;
  374. case VIOSRP_ADAPTER_INFO_TYPE:
  375. info = &iu->mad.adapter_info;
  376. info->common.status = send_adapter_info(iue, info->buffer,
  377. info->common.length);
  378. send_iu(iue, sizeof(*info), VIOSRP_MAD_FORMAT);
  379. break;
  380. case VIOSRP_HOST_CONFIG_TYPE:
  381. conf = &iu->mad.host_config;
  382. conf->common.status = 1;
  383. send_iu(iue, sizeof(*conf), VIOSRP_MAD_FORMAT);
  384. break;
  385. default:
  386. eprintk("Unknown type %u\n", iu->srp.rsp.opcode);
  387. }
  388. return 1;
  389. }
  390. static int process_srp_iu(struct iu_entry *iue)
  391. {
  392. union viosrp_iu *iu = vio_iu(iue);
  393. int done = 1;
  394. u8 opcode = iu->srp.rsp.opcode;
  395. switch (opcode) {
  396. case SRP_LOGIN_REQ:
  397. process_login(iue);
  398. break;
  399. case SRP_TSK_MGMT:
  400. done = process_tsk_mgmt(iue);
  401. break;
  402. case SRP_CMD:
  403. queue_cmd(iue);
  404. done = 0;
  405. break;
  406. case SRP_LOGIN_RSP:
  407. case SRP_I_LOGOUT:
  408. case SRP_T_LOGOUT:
  409. case SRP_RSP:
  410. case SRP_CRED_REQ:
  411. case SRP_CRED_RSP:
  412. case SRP_AER_REQ:
  413. case SRP_AER_RSP:
  414. eprintk("Unsupported type %u\n", opcode);
  415. break;
  416. default:
  417. eprintk("Unknown type %u\n", opcode);
  418. }
  419. return done;
  420. }
  421. static void process_iu(struct viosrp_crq *crq, struct srp_target *target)
  422. {
  423. struct vio_port *vport = target_to_port(target);
  424. struct iu_entry *iue;
  425. long err, done;
  426. iue = srp_iu_get(target);
  427. if (!iue) {
  428. eprintk("Error getting IU from pool, %p\n", target);
  429. return;
  430. }
  431. iue->remote_token = crq->IU_data_ptr;
  432. err = h_copy_rdma(crq->IU_length, vport->riobn,
  433. iue->remote_token, vport->liobn, iue->sbuf->dma);
  434. if (err != H_SUCCESS) {
  435. eprintk("%ld transferring data error %p\n", err, iue);
  436. done = 1;
  437. goto out;
  438. }
  439. if (crq->format == VIOSRP_MAD_FORMAT)
  440. done = process_mad_iu(iue);
  441. else
  442. done = process_srp_iu(iue);
  443. out:
  444. if (done)
  445. srp_iu_put(iue);
  446. }
  447. static irqreturn_t ibmvstgt_interrupt(int irq, void *data)
  448. {
  449. struct srp_target *target = (struct srp_target *) data;
  450. struct vio_port *vport = target_to_port(target);
  451. vio_disable_interrupts(vport->dma_dev);
  452. queue_work(vtgtd, &vport->crq_work);
  453. return IRQ_HANDLED;
  454. }
  455. static int crq_queue_create(struct crq_queue *queue, struct srp_target *target)
  456. {
  457. int err;
  458. struct vio_port *vport = target_to_port(target);
  459. queue->msgs = (struct viosrp_crq *) get_zeroed_page(GFP_KERNEL);
  460. if (!queue->msgs)
  461. goto malloc_failed;
  462. queue->size = PAGE_SIZE / sizeof(*queue->msgs);
  463. queue->msg_token = dma_map_single(target->dev, queue->msgs,
  464. queue->size * sizeof(*queue->msgs),
  465. DMA_BIDIRECTIONAL);
  466. if (dma_mapping_error(queue->msg_token))
  467. goto map_failed;
  468. err = h_reg_crq(vport->dma_dev->unit_address, queue->msg_token,
  469. PAGE_SIZE);
  470. /* If the adapter was left active for some reason (like kexec)
  471. * try freeing and re-registering
  472. */
  473. if (err == H_RESOURCE) {
  474. do {
  475. err = h_free_crq(vport->dma_dev->unit_address);
  476. } while (err == H_BUSY || H_IS_LONG_BUSY(err));
  477. err = h_reg_crq(vport->dma_dev->unit_address, queue->msg_token,
  478. PAGE_SIZE);
  479. }
  480. if (err != H_SUCCESS && err != 2) {
  481. eprintk("Error 0x%x opening virtual adapter\n", err);
  482. goto reg_crq_failed;
  483. }
  484. err = request_irq(vport->dma_dev->irq, &ibmvstgt_interrupt,
  485. SA_INTERRUPT, "ibmvstgt", target);
  486. if (err)
  487. goto req_irq_failed;
  488. vio_enable_interrupts(vport->dma_dev);
  489. h_send_crq(vport->dma_dev->unit_address, 0xC001000000000000, 0);
  490. queue->cur = 0;
  491. spin_lock_init(&queue->lock);
  492. return 0;
  493. req_irq_failed:
  494. do {
  495. err = h_free_crq(vport->dma_dev->unit_address);
  496. } while (err == H_BUSY || H_IS_LONG_BUSY(err));
  497. reg_crq_failed:
  498. dma_unmap_single(target->dev, queue->msg_token,
  499. queue->size * sizeof(*queue->msgs), DMA_BIDIRECTIONAL);
  500. map_failed:
  501. free_page((unsigned long) queue->msgs);
  502. malloc_failed:
  503. return -ENOMEM;
  504. }
  505. static void crq_queue_destroy(struct srp_target *target)
  506. {
  507. struct vio_port *vport = target_to_port(target);
  508. struct crq_queue *queue = &vport->crq_queue;
  509. int err;
  510. free_irq(vport->dma_dev->irq, target);
  511. do {
  512. err = h_free_crq(vport->dma_dev->unit_address);
  513. } while (err == H_BUSY || H_IS_LONG_BUSY(err));
  514. dma_unmap_single(target->dev, queue->msg_token,
  515. queue->size * sizeof(*queue->msgs), DMA_BIDIRECTIONAL);
  516. free_page((unsigned long) queue->msgs);
  517. }
  518. static void process_crq(struct viosrp_crq *crq, struct srp_target *target)
  519. {
  520. struct vio_port *vport = target_to_port(target);
  521. dprintk("%x %x\n", crq->valid, crq->format);
  522. switch (crq->valid) {
  523. case 0xC0:
  524. /* initialization */
  525. switch (crq->format) {
  526. case 0x01:
  527. h_send_crq(vport->dma_dev->unit_address,
  528. 0xC002000000000000, 0);
  529. break;
  530. case 0x02:
  531. break;
  532. default:
  533. eprintk("Unknown format %u\n", crq->format);
  534. }
  535. break;
  536. case 0xFF:
  537. /* transport event */
  538. break;
  539. case 0x80:
  540. /* real payload */
  541. switch (crq->format) {
  542. case VIOSRP_SRP_FORMAT:
  543. case VIOSRP_MAD_FORMAT:
  544. process_iu(crq, target);
  545. break;
  546. case VIOSRP_OS400_FORMAT:
  547. case VIOSRP_AIX_FORMAT:
  548. case VIOSRP_LINUX_FORMAT:
  549. case VIOSRP_INLINE_FORMAT:
  550. eprintk("Unsupported format %u\n", crq->format);
  551. break;
  552. default:
  553. eprintk("Unknown format %u\n", crq->format);
  554. }
  555. break;
  556. default:
  557. eprintk("unknown message type 0x%02x!?\n", crq->valid);
  558. }
  559. }
  560. static inline struct viosrp_crq *next_crq(struct crq_queue *queue)
  561. {
  562. struct viosrp_crq *crq;
  563. unsigned long flags;
  564. spin_lock_irqsave(&queue->lock, flags);
  565. crq = &queue->msgs[queue->cur];
  566. if (crq->valid & 0x80) {
  567. if (++queue->cur == queue->size)
  568. queue->cur = 0;
  569. } else
  570. crq = NULL;
  571. spin_unlock_irqrestore(&queue->lock, flags);
  572. return crq;
  573. }
  574. static void handle_crq(struct work_struct *work)
  575. {
  576. struct vio_port *vport = container_of(work, struct vio_port, crq_work);
  577. struct srp_target *target = vport->target;
  578. struct viosrp_crq *crq;
  579. int done = 0;
  580. while (!done) {
  581. while ((crq = next_crq(&vport->crq_queue)) != NULL) {
  582. process_crq(crq, target);
  583. crq->valid = 0x00;
  584. }
  585. vio_enable_interrupts(vport->dma_dev);
  586. crq = next_crq(&vport->crq_queue);
  587. if (crq) {
  588. vio_disable_interrupts(vport->dma_dev);
  589. process_crq(crq, target);
  590. crq->valid = 0x00;
  591. } else
  592. done = 1;
  593. }
  594. handle_cmd_queue(target);
  595. }
  596. static int ibmvstgt_eh_abort_handler(struct scsi_cmnd *sc)
  597. {
  598. unsigned long flags;
  599. struct iu_entry *iue = (struct iu_entry *) sc->SCp.ptr;
  600. struct srp_target *target = iue->target;
  601. dprintk("%p %p %x\n", iue, target, vio_iu(iue)->srp.cmd.cdb[0]);
  602. spin_lock_irqsave(&target->lock, flags);
  603. list_del(&iue->ilist);
  604. spin_unlock_irqrestore(&target->lock, flags);
  605. srp_iu_put(iue);
  606. return 0;
  607. }
  608. static int ibmvstgt_tsk_mgmt_response(u64 mid, int result)
  609. {
  610. struct iu_entry *iue = (struct iu_entry *) ((void *) mid);
  611. union viosrp_iu *iu = vio_iu(iue);
  612. unsigned char status, asc;
  613. eprintk("%p %d\n", iue, result);
  614. status = NO_SENSE;
  615. asc = 0;
  616. switch (iu->srp.tsk_mgmt.tsk_mgmt_func) {
  617. case SRP_TSK_ABORT_TASK:
  618. asc = 0x14;
  619. if (result)
  620. status = ABORTED_COMMAND;
  621. break;
  622. default:
  623. break;
  624. }
  625. send_rsp(iue, NULL, status, asc);
  626. srp_iu_put(iue);
  627. return 0;
  628. }
  629. static ssize_t system_id_show(struct class_device *cdev, char *buf)
  630. {
  631. return snprintf(buf, PAGE_SIZE, "%s\n", system_id);
  632. }
  633. static ssize_t partition_number_show(struct class_device *cdev, char *buf)
  634. {
  635. return snprintf(buf, PAGE_SIZE, "%x\n", partition_number);
  636. }
  637. static ssize_t unit_address_show(struct class_device *cdev, char *buf)
  638. {
  639. struct Scsi_Host *shost = class_to_shost(cdev);
  640. struct srp_target *target = host_to_srp_target(shost);
  641. struct vio_port *vport = target_to_port(target);
  642. return snprintf(buf, PAGE_SIZE, "%x\n", vport->dma_dev->unit_address);
  643. }
  644. static CLASS_DEVICE_ATTR(system_id, S_IRUGO, system_id_show, NULL);
  645. static CLASS_DEVICE_ATTR(partition_number, S_IRUGO, partition_number_show, NULL);
  646. static CLASS_DEVICE_ATTR(unit_address, S_IRUGO, unit_address_show, NULL);
  647. static struct class_device_attribute *ibmvstgt_attrs[] = {
  648. &class_device_attr_system_id,
  649. &class_device_attr_partition_number,
  650. &class_device_attr_unit_address,
  651. NULL,
  652. };
  653. static struct scsi_host_template ibmvstgt_sht = {
  654. .name = TGT_NAME,
  655. .module = THIS_MODULE,
  656. .can_queue = INITIAL_SRP_LIMIT,
  657. .sg_tablesize = SG_ALL,
  658. .use_clustering = DISABLE_CLUSTERING,
  659. .max_sectors = DEFAULT_MAX_SECTORS,
  660. .transfer_response = ibmvstgt_cmd_done,
  661. .transfer_data = ibmvstgt_transfer_data,
  662. .eh_abort_handler = ibmvstgt_eh_abort_handler,
  663. .tsk_mgmt_response = ibmvstgt_tsk_mgmt_response,
  664. .shost_attrs = ibmvstgt_attrs,
  665. .proc_name = TGT_NAME,
  666. };
  667. static int ibmvstgt_probe(struct vio_dev *dev, const struct vio_device_id *id)
  668. {
  669. struct Scsi_Host *shost;
  670. struct srp_target *target;
  671. struct vio_port *vport;
  672. unsigned int *dma, dma_size;
  673. int err = -ENOMEM;
  674. vport = kzalloc(sizeof(struct vio_port), GFP_KERNEL);
  675. if (!vport)
  676. return err;
  677. shost = scsi_host_alloc(&ibmvstgt_sht, sizeof(struct srp_target));
  678. if (!shost)
  679. goto free_vport;
  680. err = scsi_tgt_alloc_queue(shost);
  681. if (err)
  682. goto put_host;
  683. target = host_to_srp_target(shost);
  684. target->shost = shost;
  685. vport->dma_dev = dev;
  686. target->ldata = vport;
  687. vport->target = target;
  688. err = srp_target_alloc(target, &dev->dev, INITIAL_SRP_LIMIT,
  689. SRP_MAX_IU_LEN);
  690. if (err)
  691. goto put_host;
  692. dma = (unsigned int *) vio_get_attribute(dev, "ibm,my-dma-window",
  693. &dma_size);
  694. if (!dma || dma_size != 40) {
  695. eprintk("Couldn't get window property %d\n", dma_size);
  696. err = -EIO;
  697. goto free_srp_target;
  698. }
  699. vport->liobn = dma[0];
  700. vport->riobn = dma[5];
  701. INIT_WORK(&vport->crq_work, handle_crq);
  702. err = crq_queue_create(&vport->crq_queue, target);
  703. if (err)
  704. goto free_srp_target;
  705. err = scsi_add_host(shost, target->dev);
  706. if (err)
  707. goto destroy_queue;
  708. return 0;
  709. destroy_queue:
  710. crq_queue_destroy(target);
  711. free_srp_target:
  712. srp_target_free(target);
  713. put_host:
  714. scsi_host_put(shost);
  715. free_vport:
  716. kfree(vport);
  717. return err;
  718. }
  719. static int ibmvstgt_remove(struct vio_dev *dev)
  720. {
  721. struct srp_target *target = (struct srp_target *) dev->dev.driver_data;
  722. struct Scsi_Host *shost = target->shost;
  723. struct vio_port *vport = target->ldata;
  724. crq_queue_destroy(target);
  725. scsi_remove_host(shost);
  726. scsi_tgt_free_queue(shost);
  727. srp_target_free(target);
  728. kfree(vport);
  729. scsi_host_put(shost);
  730. return 0;
  731. }
  732. static struct vio_device_id ibmvstgt_device_table[] __devinitdata = {
  733. {"v-scsi-host", "IBM,v-scsi-host"},
  734. {"",""}
  735. };
  736. MODULE_DEVICE_TABLE(vio, ibmvstgt_device_table);
  737. static struct vio_driver ibmvstgt_driver = {
  738. .id_table = ibmvstgt_device_table,
  739. .probe = ibmvstgt_probe,
  740. .remove = ibmvstgt_remove,
  741. .driver = {
  742. .name = "ibmvscsis",
  743. .owner = THIS_MODULE,
  744. }
  745. };
  746. static int get_system_info(void)
  747. {
  748. struct device_node *rootdn;
  749. const char *id, *model, *name;
  750. unsigned int *num;
  751. rootdn = find_path_device("/");
  752. if (!rootdn)
  753. return -ENOENT;
  754. model = get_property(rootdn, "model", NULL);
  755. id = get_property(rootdn, "system-id", NULL);
  756. if (model && id)
  757. snprintf(system_id, sizeof(system_id), "%s-%s", model, id);
  758. name = get_property(rootdn, "ibm,partition-name", NULL);
  759. if (name)
  760. strncpy(partition_name, name, sizeof(partition_name));
  761. num = (unsigned int *) get_property(rootdn, "ibm,partition-no", NULL);
  762. if (num)
  763. partition_number = *num;
  764. return 0;
  765. }
  766. static int ibmvstgt_init(void)
  767. {
  768. int err = -ENOMEM;
  769. printk("IBM eServer i/pSeries Virtual SCSI Target Driver\n");
  770. vtgtd = create_workqueue("ibmvtgtd");
  771. if (!vtgtd)
  772. return err;
  773. err = get_system_info();
  774. if (err)
  775. goto destroy_wq;
  776. err = vio_register_driver(&ibmvstgt_driver);
  777. if (err)
  778. goto destroy_wq;
  779. return 0;
  780. destroy_wq:
  781. destroy_workqueue(vtgtd);
  782. return err;
  783. }
  784. static void ibmvstgt_exit(void)
  785. {
  786. printk("Unregister IBM virtual SCSI driver\n");
  787. destroy_workqueue(vtgtd);
  788. vio_unregister_driver(&ibmvstgt_driver);
  789. }
  790. MODULE_DESCRIPTION("IBM Virtual SCSI Target");
  791. MODULE_AUTHOR("Santiago Leon");
  792. MODULE_LICENSE("GPL");
  793. module_init(ibmvstgt_init);
  794. module_exit(ibmvstgt_exit);