ibmvstgt.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950
  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 256
  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 %ld\n", dir, slen, err);
  210. return -EIO;
  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. return -EIO;
  224. }
  225. }
  226. };
  227. rest -= mlen;
  228. }
  229. return 0;
  230. }
  231. static int ibmvstgt_cmd_done(struct scsi_cmnd *sc,
  232. void (*done)(struct scsi_cmnd *))
  233. {
  234. unsigned long flags;
  235. struct iu_entry *iue = (struct iu_entry *) sc->SCp.ptr;
  236. struct srp_target *target = iue->target;
  237. int err = 0;
  238. dprintk("%p %p %x %u\n", iue, target, vio_iu(iue)->srp.cmd.cdb[0],
  239. cmd->usg_sg);
  240. if (sc->use_sg)
  241. err = srp_transfer_data(sc, &vio_iu(iue)->srp.cmd, ibmvstgt_rdma, 1, 1);
  242. spin_lock_irqsave(&target->lock, flags);
  243. list_del(&iue->ilist);
  244. spin_unlock_irqrestore(&target->lock, flags);
  245. if (err|| sc->result != SAM_STAT_GOOD) {
  246. eprintk("operation failed %p %d %x\n",
  247. iue, sc->result, vio_iu(iue)->srp.cmd.cdb[0]);
  248. send_rsp(iue, sc, HARDWARE_ERROR, 0x00);
  249. } else
  250. send_rsp(iue, sc, NO_SENSE, 0x00);
  251. done(sc);
  252. srp_iu_put(iue);
  253. return 0;
  254. }
  255. int send_adapter_info(struct iu_entry *iue,
  256. dma_addr_t remote_buffer, uint16_t length)
  257. {
  258. struct srp_target *target = iue->target;
  259. struct vio_port *vport = target_to_port(target);
  260. struct Scsi_Host *shost = target->shost;
  261. dma_addr_t data_token;
  262. struct mad_adapter_info_data *info;
  263. int err;
  264. info = dma_alloc_coherent(target->dev, sizeof(*info), &data_token,
  265. GFP_KERNEL);
  266. if (!info) {
  267. eprintk("bad dma_alloc_coherent %p\n", target);
  268. return 1;
  269. }
  270. /* Get remote info */
  271. err = h_copy_rdma(sizeof(*info), vport->riobn, remote_buffer,
  272. vport->liobn, data_token);
  273. if (err == H_SUCCESS) {
  274. dprintk("Client connect: %s (%d)\n",
  275. info->partition_name, info->partition_number);
  276. }
  277. memset(info, 0, sizeof(*info));
  278. strcpy(info->srp_version, "16.a");
  279. strncpy(info->partition_name, partition_name,
  280. sizeof(info->partition_name));
  281. info->partition_number = partition_number;
  282. info->mad_version = 1;
  283. info->os_type = 2;
  284. info->port_max_txu[0] = shost->hostt->max_sectors << 9;
  285. /* Send our info to remote */
  286. err = h_copy_rdma(sizeof(*info), vport->liobn, data_token,
  287. vport->riobn, remote_buffer);
  288. dma_free_coherent(target->dev, sizeof(*info), info, data_token);
  289. if (err != H_SUCCESS) {
  290. eprintk("Error sending adapter info %d\n", err);
  291. return 1;
  292. }
  293. return 0;
  294. }
  295. static void process_login(struct iu_entry *iue)
  296. {
  297. union viosrp_iu *iu = vio_iu(iue);
  298. struct srp_login_rsp *rsp = &iu->srp.login_rsp;
  299. uint64_t tag = iu->srp.rsp.tag;
  300. /* TODO handle case that requested size is wrong and
  301. * buffer format is wrong
  302. */
  303. memset(iu, 0, sizeof(struct srp_login_rsp));
  304. rsp->opcode = SRP_LOGIN_RSP;
  305. rsp->req_lim_delta = INITIAL_SRP_LIMIT;
  306. rsp->tag = tag;
  307. rsp->max_it_iu_len = sizeof(union srp_iu);
  308. rsp->max_ti_iu_len = sizeof(union srp_iu);
  309. /* direct and indirect */
  310. rsp->buf_fmt = SRP_BUF_FORMAT_DIRECT | SRP_BUF_FORMAT_INDIRECT;
  311. send_iu(iue, sizeof(*rsp), VIOSRP_SRP_FORMAT);
  312. }
  313. static inline void queue_cmd(struct iu_entry *iue)
  314. {
  315. struct srp_target *target = iue->target;
  316. unsigned long flags;
  317. spin_lock_irqsave(&target->lock, flags);
  318. list_add_tail(&iue->ilist, &target->cmd_queue);
  319. spin_unlock_irqrestore(&target->lock, flags);
  320. }
  321. static int process_tsk_mgmt(struct iu_entry *iue)
  322. {
  323. union viosrp_iu *iu = vio_iu(iue);
  324. int fn;
  325. dprintk("%p %u\n", iue, iu->srp.tsk_mgmt.tsk_mgmt_func);
  326. switch (iu->srp.tsk_mgmt.tsk_mgmt_func) {
  327. case SRP_TSK_ABORT_TASK:
  328. fn = ABORT_TASK;
  329. break;
  330. case SRP_TSK_ABORT_TASK_SET:
  331. fn = ABORT_TASK_SET;
  332. break;
  333. case SRP_TSK_CLEAR_TASK_SET:
  334. fn = CLEAR_TASK_SET;
  335. break;
  336. case SRP_TSK_LUN_RESET:
  337. fn = LOGICAL_UNIT_RESET;
  338. break;
  339. case SRP_TSK_CLEAR_ACA:
  340. fn = CLEAR_ACA;
  341. break;
  342. default:
  343. fn = 0;
  344. }
  345. if (fn)
  346. scsi_tgt_tsk_mgmt_request(iue->target->shost, fn,
  347. iu->srp.tsk_mgmt.task_tag,
  348. (struct scsi_lun *) &iu->srp.tsk_mgmt.lun,
  349. iue);
  350. else
  351. send_rsp(iue, NULL, ILLEGAL_REQUEST, 0x20);
  352. return !fn;
  353. }
  354. static int process_mad_iu(struct iu_entry *iue)
  355. {
  356. union viosrp_iu *iu = vio_iu(iue);
  357. struct viosrp_adapter_info *info;
  358. struct viosrp_host_config *conf;
  359. switch (iu->mad.empty_iu.common.type) {
  360. case VIOSRP_EMPTY_IU_TYPE:
  361. eprintk("%s\n", "Unsupported EMPTY MAD IU");
  362. break;
  363. case VIOSRP_ERROR_LOG_TYPE:
  364. eprintk("%s\n", "Unsupported ERROR LOG MAD IU");
  365. iu->mad.error_log.common.status = 1;
  366. send_iu(iue, sizeof(iu->mad.error_log), VIOSRP_MAD_FORMAT);
  367. break;
  368. case VIOSRP_ADAPTER_INFO_TYPE:
  369. info = &iu->mad.adapter_info;
  370. info->common.status = send_adapter_info(iue, info->buffer,
  371. info->common.length);
  372. send_iu(iue, sizeof(*info), VIOSRP_MAD_FORMAT);
  373. break;
  374. case VIOSRP_HOST_CONFIG_TYPE:
  375. conf = &iu->mad.host_config;
  376. conf->common.status = 1;
  377. send_iu(iue, sizeof(*conf), VIOSRP_MAD_FORMAT);
  378. break;
  379. default:
  380. eprintk("Unknown type %u\n", iu->srp.rsp.opcode);
  381. }
  382. return 1;
  383. }
  384. static int process_srp_iu(struct iu_entry *iue)
  385. {
  386. union viosrp_iu *iu = vio_iu(iue);
  387. int done = 1;
  388. u8 opcode = iu->srp.rsp.opcode;
  389. switch (opcode) {
  390. case SRP_LOGIN_REQ:
  391. process_login(iue);
  392. break;
  393. case SRP_TSK_MGMT:
  394. done = process_tsk_mgmt(iue);
  395. break;
  396. case SRP_CMD:
  397. queue_cmd(iue);
  398. done = 0;
  399. break;
  400. case SRP_LOGIN_RSP:
  401. case SRP_I_LOGOUT:
  402. case SRP_T_LOGOUT:
  403. case SRP_RSP:
  404. case SRP_CRED_REQ:
  405. case SRP_CRED_RSP:
  406. case SRP_AER_REQ:
  407. case SRP_AER_RSP:
  408. eprintk("Unsupported type %u\n", opcode);
  409. break;
  410. default:
  411. eprintk("Unknown type %u\n", opcode);
  412. }
  413. return done;
  414. }
  415. static void process_iu(struct viosrp_crq *crq, struct srp_target *target)
  416. {
  417. struct vio_port *vport = target_to_port(target);
  418. struct iu_entry *iue;
  419. long err;
  420. int done = 1;
  421. iue = srp_iu_get(target);
  422. if (!iue) {
  423. eprintk("Error getting IU from pool, %p\n", target);
  424. return;
  425. }
  426. iue->remote_token = crq->IU_data_ptr;
  427. err = h_copy_rdma(crq->IU_length, vport->riobn,
  428. iue->remote_token, vport->liobn, iue->sbuf->dma);
  429. if (err != H_SUCCESS) {
  430. eprintk("%ld transferring data error %p\n", err, iue);
  431. goto out;
  432. }
  433. if (crq->format == VIOSRP_MAD_FORMAT)
  434. done = process_mad_iu(iue);
  435. else
  436. done = process_srp_iu(iue);
  437. out:
  438. if (done)
  439. srp_iu_put(iue);
  440. }
  441. static irqreturn_t ibmvstgt_interrupt(int irq, void *data)
  442. {
  443. struct srp_target *target = (struct srp_target *) data;
  444. struct vio_port *vport = target_to_port(target);
  445. vio_disable_interrupts(vport->dma_dev);
  446. queue_work(vtgtd, &vport->crq_work);
  447. return IRQ_HANDLED;
  448. }
  449. static int crq_queue_create(struct crq_queue *queue, struct srp_target *target)
  450. {
  451. int err;
  452. struct vio_port *vport = target_to_port(target);
  453. queue->msgs = (struct viosrp_crq *) get_zeroed_page(GFP_KERNEL);
  454. if (!queue->msgs)
  455. goto malloc_failed;
  456. queue->size = PAGE_SIZE / sizeof(*queue->msgs);
  457. queue->msg_token = dma_map_single(target->dev, queue->msgs,
  458. queue->size * sizeof(*queue->msgs),
  459. DMA_BIDIRECTIONAL);
  460. if (dma_mapping_error(queue->msg_token))
  461. goto map_failed;
  462. err = h_reg_crq(vport->dma_dev->unit_address, queue->msg_token,
  463. PAGE_SIZE);
  464. /* If the adapter was left active for some reason (like kexec)
  465. * try freeing and re-registering
  466. */
  467. if (err == H_RESOURCE) {
  468. do {
  469. err = h_free_crq(vport->dma_dev->unit_address);
  470. } while (err == H_BUSY || H_IS_LONG_BUSY(err));
  471. err = h_reg_crq(vport->dma_dev->unit_address, queue->msg_token,
  472. PAGE_SIZE);
  473. }
  474. if (err != H_SUCCESS && err != 2) {
  475. eprintk("Error 0x%x opening virtual adapter\n", err);
  476. goto reg_crq_failed;
  477. }
  478. err = request_irq(vport->dma_dev->irq, &ibmvstgt_interrupt,
  479. IRQF_DISABLED, "ibmvstgt", target);
  480. if (err)
  481. goto req_irq_failed;
  482. vio_enable_interrupts(vport->dma_dev);
  483. h_send_crq(vport->dma_dev->unit_address, 0xC001000000000000, 0);
  484. queue->cur = 0;
  485. spin_lock_init(&queue->lock);
  486. return 0;
  487. req_irq_failed:
  488. do {
  489. err = h_free_crq(vport->dma_dev->unit_address);
  490. } while (err == H_BUSY || H_IS_LONG_BUSY(err));
  491. reg_crq_failed:
  492. dma_unmap_single(target->dev, queue->msg_token,
  493. queue->size * sizeof(*queue->msgs), DMA_BIDIRECTIONAL);
  494. map_failed:
  495. free_page((unsigned long) queue->msgs);
  496. malloc_failed:
  497. return -ENOMEM;
  498. }
  499. static void crq_queue_destroy(struct srp_target *target)
  500. {
  501. struct vio_port *vport = target_to_port(target);
  502. struct crq_queue *queue = &vport->crq_queue;
  503. int err;
  504. free_irq(vport->dma_dev->irq, target);
  505. do {
  506. err = h_free_crq(vport->dma_dev->unit_address);
  507. } while (err == H_BUSY || H_IS_LONG_BUSY(err));
  508. dma_unmap_single(target->dev, queue->msg_token,
  509. queue->size * sizeof(*queue->msgs), DMA_BIDIRECTIONAL);
  510. free_page((unsigned long) queue->msgs);
  511. }
  512. static void process_crq(struct viosrp_crq *crq, struct srp_target *target)
  513. {
  514. struct vio_port *vport = target_to_port(target);
  515. dprintk("%x %x\n", crq->valid, crq->format);
  516. switch (crq->valid) {
  517. case 0xC0:
  518. /* initialization */
  519. switch (crq->format) {
  520. case 0x01:
  521. h_send_crq(vport->dma_dev->unit_address,
  522. 0xC002000000000000, 0);
  523. break;
  524. case 0x02:
  525. break;
  526. default:
  527. eprintk("Unknown format %u\n", crq->format);
  528. }
  529. break;
  530. case 0xFF:
  531. /* transport event */
  532. break;
  533. case 0x80:
  534. /* real payload */
  535. switch (crq->format) {
  536. case VIOSRP_SRP_FORMAT:
  537. case VIOSRP_MAD_FORMAT:
  538. process_iu(crq, target);
  539. break;
  540. case VIOSRP_OS400_FORMAT:
  541. case VIOSRP_AIX_FORMAT:
  542. case VIOSRP_LINUX_FORMAT:
  543. case VIOSRP_INLINE_FORMAT:
  544. eprintk("Unsupported format %u\n", crq->format);
  545. break;
  546. default:
  547. eprintk("Unknown format %u\n", crq->format);
  548. }
  549. break;
  550. default:
  551. eprintk("unknown message type 0x%02x!?\n", crq->valid);
  552. }
  553. }
  554. static inline struct viosrp_crq *next_crq(struct crq_queue *queue)
  555. {
  556. struct viosrp_crq *crq;
  557. unsigned long flags;
  558. spin_lock_irqsave(&queue->lock, flags);
  559. crq = &queue->msgs[queue->cur];
  560. if (crq->valid & 0x80) {
  561. if (++queue->cur == queue->size)
  562. queue->cur = 0;
  563. } else
  564. crq = NULL;
  565. spin_unlock_irqrestore(&queue->lock, flags);
  566. return crq;
  567. }
  568. static void handle_crq(struct work_struct *work)
  569. {
  570. struct vio_port *vport = container_of(work, struct vio_port, crq_work);
  571. struct srp_target *target = vport->target;
  572. struct viosrp_crq *crq;
  573. int done = 0;
  574. while (!done) {
  575. while ((crq = next_crq(&vport->crq_queue)) != NULL) {
  576. process_crq(crq, target);
  577. crq->valid = 0x00;
  578. }
  579. vio_enable_interrupts(vport->dma_dev);
  580. crq = next_crq(&vport->crq_queue);
  581. if (crq) {
  582. vio_disable_interrupts(vport->dma_dev);
  583. process_crq(crq, target);
  584. crq->valid = 0x00;
  585. } else
  586. done = 1;
  587. }
  588. handle_cmd_queue(target);
  589. }
  590. static int ibmvstgt_eh_abort_handler(struct scsi_cmnd *sc)
  591. {
  592. unsigned long flags;
  593. struct iu_entry *iue = (struct iu_entry *) sc->SCp.ptr;
  594. struct srp_target *target = iue->target;
  595. dprintk("%p %p %x\n", iue, target, vio_iu(iue)->srp.cmd.cdb[0]);
  596. spin_lock_irqsave(&target->lock, flags);
  597. list_del(&iue->ilist);
  598. spin_unlock_irqrestore(&target->lock, flags);
  599. srp_iu_put(iue);
  600. return 0;
  601. }
  602. static int ibmvstgt_tsk_mgmt_response(u64 mid, int result)
  603. {
  604. struct iu_entry *iue = (struct iu_entry *) ((void *) mid);
  605. union viosrp_iu *iu = vio_iu(iue);
  606. unsigned char status, asc;
  607. eprintk("%p %d\n", iue, result);
  608. status = NO_SENSE;
  609. asc = 0;
  610. switch (iu->srp.tsk_mgmt.tsk_mgmt_func) {
  611. case SRP_TSK_ABORT_TASK:
  612. asc = 0x14;
  613. if (result)
  614. status = ABORTED_COMMAND;
  615. break;
  616. default:
  617. break;
  618. }
  619. send_rsp(iue, NULL, status, asc);
  620. srp_iu_put(iue);
  621. return 0;
  622. }
  623. static ssize_t system_id_show(struct class_device *cdev, char *buf)
  624. {
  625. return snprintf(buf, PAGE_SIZE, "%s\n", system_id);
  626. }
  627. static ssize_t partition_number_show(struct class_device *cdev, char *buf)
  628. {
  629. return snprintf(buf, PAGE_SIZE, "%x\n", partition_number);
  630. }
  631. static ssize_t unit_address_show(struct class_device *cdev, char *buf)
  632. {
  633. struct Scsi_Host *shost = class_to_shost(cdev);
  634. struct srp_target *target = host_to_srp_target(shost);
  635. struct vio_port *vport = target_to_port(target);
  636. return snprintf(buf, PAGE_SIZE, "%x\n", vport->dma_dev->unit_address);
  637. }
  638. static CLASS_DEVICE_ATTR(system_id, S_IRUGO, system_id_show, NULL);
  639. static CLASS_DEVICE_ATTR(partition_number, S_IRUGO, partition_number_show, NULL);
  640. static CLASS_DEVICE_ATTR(unit_address, S_IRUGO, unit_address_show, NULL);
  641. static struct class_device_attribute *ibmvstgt_attrs[] = {
  642. &class_device_attr_system_id,
  643. &class_device_attr_partition_number,
  644. &class_device_attr_unit_address,
  645. NULL,
  646. };
  647. static struct scsi_host_template ibmvstgt_sht = {
  648. .name = TGT_NAME,
  649. .module = THIS_MODULE,
  650. .can_queue = INITIAL_SRP_LIMIT,
  651. .sg_tablesize = SG_ALL,
  652. .use_clustering = DISABLE_CLUSTERING,
  653. .max_sectors = DEFAULT_MAX_SECTORS,
  654. .transfer_response = ibmvstgt_cmd_done,
  655. .eh_abort_handler = ibmvstgt_eh_abort_handler,
  656. .tsk_mgmt_response = ibmvstgt_tsk_mgmt_response,
  657. .shost_attrs = ibmvstgt_attrs,
  658. .proc_name = TGT_NAME,
  659. };
  660. static int ibmvstgt_probe(struct vio_dev *dev, const struct vio_device_id *id)
  661. {
  662. struct Scsi_Host *shost;
  663. struct srp_target *target;
  664. struct vio_port *vport;
  665. unsigned int *dma, dma_size;
  666. int err = -ENOMEM;
  667. vport = kzalloc(sizeof(struct vio_port), GFP_KERNEL);
  668. if (!vport)
  669. return err;
  670. shost = scsi_host_alloc(&ibmvstgt_sht, sizeof(struct srp_target));
  671. if (!shost)
  672. goto free_vport;
  673. err = scsi_tgt_alloc_queue(shost);
  674. if (err)
  675. goto put_host;
  676. target = host_to_srp_target(shost);
  677. target->shost = shost;
  678. vport->dma_dev = dev;
  679. target->ldata = vport;
  680. vport->target = target;
  681. err = srp_target_alloc(target, &dev->dev, INITIAL_SRP_LIMIT,
  682. SRP_MAX_IU_LEN);
  683. if (err)
  684. goto put_host;
  685. dma = (unsigned int *) vio_get_attribute(dev, "ibm,my-dma-window",
  686. &dma_size);
  687. if (!dma || dma_size != 40) {
  688. eprintk("Couldn't get window property %d\n", dma_size);
  689. err = -EIO;
  690. goto free_srp_target;
  691. }
  692. vport->liobn = dma[0];
  693. vport->riobn = dma[5];
  694. INIT_WORK(&vport->crq_work, handle_crq);
  695. err = crq_queue_create(&vport->crq_queue, target);
  696. if (err)
  697. goto free_srp_target;
  698. err = scsi_add_host(shost, target->dev);
  699. if (err)
  700. goto destroy_queue;
  701. return 0;
  702. destroy_queue:
  703. crq_queue_destroy(target);
  704. free_srp_target:
  705. srp_target_free(target);
  706. put_host:
  707. scsi_host_put(shost);
  708. free_vport:
  709. kfree(vport);
  710. return err;
  711. }
  712. static int ibmvstgt_remove(struct vio_dev *dev)
  713. {
  714. struct srp_target *target = (struct srp_target *) dev->dev.driver_data;
  715. struct Scsi_Host *shost = target->shost;
  716. struct vio_port *vport = target->ldata;
  717. crq_queue_destroy(target);
  718. scsi_remove_host(shost);
  719. scsi_tgt_free_queue(shost);
  720. srp_target_free(target);
  721. kfree(vport);
  722. scsi_host_put(shost);
  723. return 0;
  724. }
  725. static struct vio_device_id ibmvstgt_device_table[] __devinitdata = {
  726. {"v-scsi-host", "IBM,v-scsi-host"},
  727. {"",""}
  728. };
  729. MODULE_DEVICE_TABLE(vio, ibmvstgt_device_table);
  730. static struct vio_driver ibmvstgt_driver = {
  731. .id_table = ibmvstgt_device_table,
  732. .probe = ibmvstgt_probe,
  733. .remove = ibmvstgt_remove,
  734. .driver = {
  735. .name = "ibmvscsis",
  736. .owner = THIS_MODULE,
  737. }
  738. };
  739. static int get_system_info(void)
  740. {
  741. struct device_node *rootdn;
  742. const char *id, *model, *name;
  743. const unsigned int *num;
  744. rootdn = of_find_node_by_path("/");
  745. if (!rootdn)
  746. return -ENOENT;
  747. model = of_get_property(rootdn, "model", NULL);
  748. id = of_get_property(rootdn, "system-id", NULL);
  749. if (model && id)
  750. snprintf(system_id, sizeof(system_id), "%s-%s", model, id);
  751. name = of_get_property(rootdn, "ibm,partition-name", NULL);
  752. if (name)
  753. strncpy(partition_name, name, sizeof(partition_name));
  754. num = of_get_property(rootdn, "ibm,partition-no", NULL);
  755. if (num)
  756. partition_number = *num;
  757. of_node_put(rootdn);
  758. return 0;
  759. }
  760. static int ibmvstgt_init(void)
  761. {
  762. int err = -ENOMEM;
  763. printk("IBM eServer i/pSeries Virtual SCSI Target Driver\n");
  764. vtgtd = create_workqueue("ibmvtgtd");
  765. if (!vtgtd)
  766. return err;
  767. err = get_system_info();
  768. if (err)
  769. goto destroy_wq;
  770. err = vio_register_driver(&ibmvstgt_driver);
  771. if (err)
  772. goto destroy_wq;
  773. return 0;
  774. destroy_wq:
  775. destroy_workqueue(vtgtd);
  776. return err;
  777. }
  778. static void ibmvstgt_exit(void)
  779. {
  780. printk("Unregister IBM virtual SCSI driver\n");
  781. destroy_workqueue(vtgtd);
  782. vio_unregister_driver(&ibmvstgt_driver);
  783. }
  784. MODULE_DESCRIPTION("IBM Virtual SCSI Target");
  785. MODULE_AUTHOR("Santiago Leon");
  786. MODULE_LICENSE("GPL");
  787. module_init(ibmvstgt_init);
  788. module_exit(ibmvstgt_exit);