qdio_main.c 38 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597
  1. /*
  2. * linux/drivers/s390/cio/qdio_main.c
  3. *
  4. * Linux for s390 qdio support, buffer handling, qdio API and module support.
  5. *
  6. * Copyright 2000,2008 IBM Corp.
  7. * Author(s): Utz Bacher <utz.bacher@de.ibm.com>
  8. * Jan Glauber <jang@linux.vnet.ibm.com>
  9. * 2.6 cio integration by Cornelia Huck <cornelia.huck@de.ibm.com>
  10. */
  11. #include <linux/module.h>
  12. #include <linux/init.h>
  13. #include <linux/kernel.h>
  14. #include <linux/timer.h>
  15. #include <linux/delay.h>
  16. #include <linux/gfp.h>
  17. #include <asm/atomic.h>
  18. #include <asm/debug.h>
  19. #include <asm/qdio.h>
  20. #include "cio.h"
  21. #include "css.h"
  22. #include "device.h"
  23. #include "qdio.h"
  24. #include "qdio_debug.h"
  25. MODULE_AUTHOR("Utz Bacher <utz.bacher@de.ibm.com>,"\
  26. "Jan Glauber <jang@linux.vnet.ibm.com>");
  27. MODULE_DESCRIPTION("QDIO base support");
  28. MODULE_LICENSE("GPL");
  29. static inline int do_siga_sync(struct subchannel_id schid,
  30. unsigned int out_mask, unsigned int in_mask)
  31. {
  32. register unsigned long __fc asm ("0") = 2;
  33. register struct subchannel_id __schid asm ("1") = schid;
  34. register unsigned long out asm ("2") = out_mask;
  35. register unsigned long in asm ("3") = in_mask;
  36. int cc;
  37. asm volatile(
  38. " siga 0\n"
  39. " ipm %0\n"
  40. " srl %0,28\n"
  41. : "=d" (cc)
  42. : "d" (__fc), "d" (__schid), "d" (out), "d" (in) : "cc");
  43. return cc;
  44. }
  45. static inline int do_siga_input(struct subchannel_id schid, unsigned int mask)
  46. {
  47. register unsigned long __fc asm ("0") = 1;
  48. register struct subchannel_id __schid asm ("1") = schid;
  49. register unsigned long __mask asm ("2") = mask;
  50. int cc;
  51. asm volatile(
  52. " siga 0\n"
  53. " ipm %0\n"
  54. " srl %0,28\n"
  55. : "=d" (cc)
  56. : "d" (__fc), "d" (__schid), "d" (__mask) : "cc", "memory");
  57. return cc;
  58. }
  59. /**
  60. * do_siga_output - perform SIGA-w/wt function
  61. * @schid: subchannel id or in case of QEBSM the subchannel token
  62. * @mask: which output queues to process
  63. * @bb: busy bit indicator, set only if SIGA-w/wt could not access a buffer
  64. * @fc: function code to perform
  65. *
  66. * Returns cc or QDIO_ERROR_SIGA_ACCESS_EXCEPTION.
  67. * Note: For IQDC unicast queues only the highest priority queue is processed.
  68. */
  69. static inline int do_siga_output(unsigned long schid, unsigned long mask,
  70. unsigned int *bb, unsigned int fc)
  71. {
  72. register unsigned long __fc asm("0") = fc;
  73. register unsigned long __schid asm("1") = schid;
  74. register unsigned long __mask asm("2") = mask;
  75. int cc = QDIO_ERROR_SIGA_ACCESS_EXCEPTION;
  76. asm volatile(
  77. " siga 0\n"
  78. "0: ipm %0\n"
  79. " srl %0,28\n"
  80. "1:\n"
  81. EX_TABLE(0b, 1b)
  82. : "+d" (cc), "+d" (__fc), "+d" (__schid), "+d" (__mask)
  83. : : "cc", "memory");
  84. *bb = ((unsigned int) __fc) >> 31;
  85. return cc;
  86. }
  87. static inline int qdio_check_ccq(struct qdio_q *q, unsigned int ccq)
  88. {
  89. /* all done or next buffer state different */
  90. if (ccq == 0 || ccq == 32)
  91. return 0;
  92. /* not all buffers processed */
  93. if (ccq == 96 || ccq == 97)
  94. return 1;
  95. /* notify devices immediately */
  96. DBF_ERROR("%4x ccq:%3d", SCH_NO(q), ccq);
  97. return -EIO;
  98. }
  99. /**
  100. * qdio_do_eqbs - extract buffer states for QEBSM
  101. * @q: queue to manipulate
  102. * @state: state of the extracted buffers
  103. * @start: buffer number to start at
  104. * @count: count of buffers to examine
  105. * @auto_ack: automatically acknowledge buffers
  106. *
  107. * Returns the number of successfully extracted equal buffer states.
  108. * Stops processing if a state is different from the last buffers state.
  109. */
  110. static int qdio_do_eqbs(struct qdio_q *q, unsigned char *state,
  111. int start, int count, int auto_ack)
  112. {
  113. unsigned int ccq = 0;
  114. int tmp_count = count, tmp_start = start;
  115. int nr = q->nr;
  116. int rc;
  117. BUG_ON(!q->irq_ptr->sch_token);
  118. qperf_inc(q, eqbs);
  119. if (!q->is_input_q)
  120. nr += q->irq_ptr->nr_input_qs;
  121. again:
  122. ccq = do_eqbs(q->irq_ptr->sch_token, state, nr, &tmp_start, &tmp_count,
  123. auto_ack);
  124. rc = qdio_check_ccq(q, ccq);
  125. /* At least one buffer was processed, return and extract the remaining
  126. * buffers later.
  127. */
  128. if ((ccq == 96) && (count != tmp_count)) {
  129. qperf_inc(q, eqbs_partial);
  130. return (count - tmp_count);
  131. }
  132. if (rc == 1) {
  133. DBF_DEV_EVENT(DBF_WARN, q->irq_ptr, "EQBS again:%2d", ccq);
  134. goto again;
  135. }
  136. if (rc < 0) {
  137. DBF_ERROR("%4x EQBS ERROR", SCH_NO(q));
  138. DBF_ERROR("%3d%3d%2d", count, tmp_count, nr);
  139. q->handler(q->irq_ptr->cdev,
  140. QDIO_ERROR_ACTIVATE_CHECK_CONDITION,
  141. 0, -1, -1, q->irq_ptr->int_parm);
  142. return 0;
  143. }
  144. return count - tmp_count;
  145. }
  146. /**
  147. * qdio_do_sqbs - set buffer states for QEBSM
  148. * @q: queue to manipulate
  149. * @state: new state of the buffers
  150. * @start: first buffer number to change
  151. * @count: how many buffers to change
  152. *
  153. * Returns the number of successfully changed buffers.
  154. * Does retrying until the specified count of buffer states is set or an
  155. * error occurs.
  156. */
  157. static int qdio_do_sqbs(struct qdio_q *q, unsigned char state, int start,
  158. int count)
  159. {
  160. unsigned int ccq = 0;
  161. int tmp_count = count, tmp_start = start;
  162. int nr = q->nr;
  163. int rc;
  164. if (!count)
  165. return 0;
  166. BUG_ON(!q->irq_ptr->sch_token);
  167. qperf_inc(q, sqbs);
  168. if (!q->is_input_q)
  169. nr += q->irq_ptr->nr_input_qs;
  170. again:
  171. ccq = do_sqbs(q->irq_ptr->sch_token, state, nr, &tmp_start, &tmp_count);
  172. rc = qdio_check_ccq(q, ccq);
  173. if (rc == 1) {
  174. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "SQBS again:%2d", ccq);
  175. qperf_inc(q, sqbs_partial);
  176. goto again;
  177. }
  178. if (rc < 0) {
  179. DBF_ERROR("%4x SQBS ERROR", SCH_NO(q));
  180. DBF_ERROR("%3d%3d%2d", count, tmp_count, nr);
  181. q->handler(q->irq_ptr->cdev,
  182. QDIO_ERROR_ACTIVATE_CHECK_CONDITION,
  183. 0, -1, -1, q->irq_ptr->int_parm);
  184. return 0;
  185. }
  186. WARN_ON(tmp_count);
  187. return count - tmp_count;
  188. }
  189. /* returns number of examined buffers and their common state in *state */
  190. static inline int get_buf_states(struct qdio_q *q, unsigned int bufnr,
  191. unsigned char *state, unsigned int count,
  192. int auto_ack)
  193. {
  194. unsigned char __state = 0;
  195. int i;
  196. BUG_ON(bufnr > QDIO_MAX_BUFFERS_MASK);
  197. BUG_ON(count > QDIO_MAX_BUFFERS_PER_Q);
  198. if (is_qebsm(q))
  199. return qdio_do_eqbs(q, state, bufnr, count, auto_ack);
  200. for (i = 0; i < count; i++) {
  201. if (!__state)
  202. __state = q->slsb.val[bufnr];
  203. else if (q->slsb.val[bufnr] != __state)
  204. break;
  205. bufnr = next_buf(bufnr);
  206. }
  207. *state = __state;
  208. return i;
  209. }
  210. static inline int get_buf_state(struct qdio_q *q, unsigned int bufnr,
  211. unsigned char *state, int auto_ack)
  212. {
  213. return get_buf_states(q, bufnr, state, 1, auto_ack);
  214. }
  215. /* wrap-around safe setting of slsb states, returns number of changed buffers */
  216. static inline int set_buf_states(struct qdio_q *q, int bufnr,
  217. unsigned char state, int count)
  218. {
  219. int i;
  220. BUG_ON(bufnr > QDIO_MAX_BUFFERS_MASK);
  221. BUG_ON(count > QDIO_MAX_BUFFERS_PER_Q);
  222. if (is_qebsm(q))
  223. return qdio_do_sqbs(q, state, bufnr, count);
  224. for (i = 0; i < count; i++) {
  225. xchg(&q->slsb.val[bufnr], state);
  226. bufnr = next_buf(bufnr);
  227. }
  228. return count;
  229. }
  230. static inline int set_buf_state(struct qdio_q *q, int bufnr,
  231. unsigned char state)
  232. {
  233. return set_buf_states(q, bufnr, state, 1);
  234. }
  235. /* set slsb states to initial state */
  236. void qdio_init_buf_states(struct qdio_irq *irq_ptr)
  237. {
  238. struct qdio_q *q;
  239. int i;
  240. for_each_input_queue(irq_ptr, q, i)
  241. set_buf_states(q, 0, SLSB_P_INPUT_NOT_INIT,
  242. QDIO_MAX_BUFFERS_PER_Q);
  243. for_each_output_queue(irq_ptr, q, i)
  244. set_buf_states(q, 0, SLSB_P_OUTPUT_NOT_INIT,
  245. QDIO_MAX_BUFFERS_PER_Q);
  246. }
  247. static inline int qdio_siga_sync(struct qdio_q *q, unsigned int output,
  248. unsigned int input)
  249. {
  250. int cc;
  251. if (!need_siga_sync(q))
  252. return 0;
  253. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "siga-s:%1d", q->nr);
  254. qperf_inc(q, siga_sync);
  255. cc = do_siga_sync(q->irq_ptr->schid, output, input);
  256. if (cc)
  257. DBF_ERROR("%4x SIGA-S:%2d", SCH_NO(q), cc);
  258. return cc;
  259. }
  260. static inline int qdio_siga_sync_q(struct qdio_q *q)
  261. {
  262. if (q->is_input_q)
  263. return qdio_siga_sync(q, 0, q->mask);
  264. else
  265. return qdio_siga_sync(q, q->mask, 0);
  266. }
  267. static inline int qdio_siga_sync_out(struct qdio_q *q)
  268. {
  269. return qdio_siga_sync(q, ~0U, 0);
  270. }
  271. static inline int qdio_siga_sync_all(struct qdio_q *q)
  272. {
  273. return qdio_siga_sync(q, ~0U, ~0U);
  274. }
  275. static int qdio_siga_output(struct qdio_q *q, unsigned int *busy_bit)
  276. {
  277. unsigned long schid;
  278. unsigned int fc = 0;
  279. u64 start_time = 0;
  280. int cc;
  281. if (q->u.out.use_enh_siga)
  282. fc = 3;
  283. if (is_qebsm(q)) {
  284. schid = q->irq_ptr->sch_token;
  285. fc |= 0x80;
  286. }
  287. else
  288. schid = *((u32 *)&q->irq_ptr->schid);
  289. again:
  290. cc = do_siga_output(schid, q->mask, busy_bit, fc);
  291. /* hipersocket busy condition */
  292. if (*busy_bit) {
  293. WARN_ON(queue_type(q) != QDIO_IQDIO_QFMT || cc != 2);
  294. if (!start_time) {
  295. start_time = get_usecs();
  296. goto again;
  297. }
  298. if ((get_usecs() - start_time) < QDIO_BUSY_BIT_PATIENCE)
  299. goto again;
  300. }
  301. return cc;
  302. }
  303. static inline int qdio_siga_input(struct qdio_q *q)
  304. {
  305. int cc;
  306. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "siga-r:%1d", q->nr);
  307. qperf_inc(q, siga_read);
  308. cc = do_siga_input(q->irq_ptr->schid, q->mask);
  309. if (cc)
  310. DBF_ERROR("%4x SIGA-R:%2d", SCH_NO(q), cc);
  311. return cc;
  312. }
  313. static inline void qdio_sync_after_thinint(struct qdio_q *q)
  314. {
  315. if (pci_out_supported(q)) {
  316. if (need_siga_sync_thinint(q))
  317. qdio_siga_sync_all(q);
  318. else if (need_siga_sync_out_thinint(q))
  319. qdio_siga_sync_out(q);
  320. } else
  321. qdio_siga_sync_q(q);
  322. }
  323. int debug_get_buf_state(struct qdio_q *q, unsigned int bufnr,
  324. unsigned char *state)
  325. {
  326. qdio_siga_sync_q(q);
  327. return get_buf_states(q, bufnr, state, 1, 0);
  328. }
  329. static inline void qdio_stop_polling(struct qdio_q *q)
  330. {
  331. if (!q->u.in.polling)
  332. return;
  333. q->u.in.polling = 0;
  334. qperf_inc(q, stop_polling);
  335. /* show the card that we are not polling anymore */
  336. if (is_qebsm(q)) {
  337. set_buf_states(q, q->u.in.ack_start, SLSB_P_INPUT_NOT_INIT,
  338. q->u.in.ack_count);
  339. q->u.in.ack_count = 0;
  340. } else
  341. set_buf_state(q, q->u.in.ack_start, SLSB_P_INPUT_NOT_INIT);
  342. }
  343. static inline void account_sbals(struct qdio_q *q, int count)
  344. {
  345. int pos = 0;
  346. q->q_stats.nr_sbal_total += count;
  347. if (count == QDIO_MAX_BUFFERS_MASK) {
  348. q->q_stats.nr_sbals[7]++;
  349. return;
  350. }
  351. while (count >>= 1)
  352. pos++;
  353. q->q_stats.nr_sbals[pos]++;
  354. }
  355. static void announce_buffer_error(struct qdio_q *q, int count)
  356. {
  357. q->qdio_error |= QDIO_ERROR_SLSB_STATE;
  358. /* special handling for no target buffer empty */
  359. if ((!q->is_input_q &&
  360. (q->sbal[q->first_to_check]->element[15].flags & 0xff) == 0x10)) {
  361. qperf_inc(q, target_full);
  362. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "OUTFULL FTC:%02x",
  363. q->first_to_check);
  364. return;
  365. }
  366. DBF_ERROR("%4x BUF ERROR", SCH_NO(q));
  367. DBF_ERROR((q->is_input_q) ? "IN:%2d" : "OUT:%2d", q->nr);
  368. DBF_ERROR("FTC:%3d C:%3d", q->first_to_check, count);
  369. DBF_ERROR("F14:%2x F15:%2x",
  370. q->sbal[q->first_to_check]->element[14].flags & 0xff,
  371. q->sbal[q->first_to_check]->element[15].flags & 0xff);
  372. }
  373. static inline void inbound_primed(struct qdio_q *q, int count)
  374. {
  375. int new;
  376. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "in prim: %02x", count);
  377. /* for QEBSM the ACK was already set by EQBS */
  378. if (is_qebsm(q)) {
  379. if (!q->u.in.polling) {
  380. q->u.in.polling = 1;
  381. q->u.in.ack_count = count;
  382. q->u.in.ack_start = q->first_to_check;
  383. return;
  384. }
  385. /* delete the previous ACK's */
  386. set_buf_states(q, q->u.in.ack_start, SLSB_P_INPUT_NOT_INIT,
  387. q->u.in.ack_count);
  388. q->u.in.ack_count = count;
  389. q->u.in.ack_start = q->first_to_check;
  390. return;
  391. }
  392. /*
  393. * ACK the newest buffer. The ACK will be removed in qdio_stop_polling
  394. * or by the next inbound run.
  395. */
  396. new = add_buf(q->first_to_check, count - 1);
  397. if (q->u.in.polling) {
  398. /* reset the previous ACK but first set the new one */
  399. set_buf_state(q, new, SLSB_P_INPUT_ACK);
  400. set_buf_state(q, q->u.in.ack_start, SLSB_P_INPUT_NOT_INIT);
  401. } else {
  402. q->u.in.polling = 1;
  403. set_buf_state(q, new, SLSB_P_INPUT_ACK);
  404. }
  405. q->u.in.ack_start = new;
  406. count--;
  407. if (!count)
  408. return;
  409. /* need to change ALL buffers to get more interrupts */
  410. set_buf_states(q, q->first_to_check, SLSB_P_INPUT_NOT_INIT, count);
  411. }
  412. static int get_inbound_buffer_frontier(struct qdio_q *q)
  413. {
  414. int count, stop;
  415. unsigned char state;
  416. /*
  417. * Don't check 128 buffers, as otherwise qdio_inbound_q_moved
  418. * would return 0.
  419. */
  420. count = min(atomic_read(&q->nr_buf_used), QDIO_MAX_BUFFERS_MASK);
  421. stop = add_buf(q->first_to_check, count);
  422. if (q->first_to_check == stop)
  423. goto out;
  424. /*
  425. * No siga sync here, as a PCI or we after a thin interrupt
  426. * already sync'ed the queues.
  427. */
  428. count = get_buf_states(q, q->first_to_check, &state, count, 1);
  429. if (!count)
  430. goto out;
  431. switch (state) {
  432. case SLSB_P_INPUT_PRIMED:
  433. inbound_primed(q, count);
  434. q->first_to_check = add_buf(q->first_to_check, count);
  435. if (atomic_sub(count, &q->nr_buf_used) == 0)
  436. qperf_inc(q, inbound_queue_full);
  437. if (q->irq_ptr->perf_stat_enabled)
  438. account_sbals(q, count);
  439. break;
  440. case SLSB_P_INPUT_ERROR:
  441. announce_buffer_error(q, count);
  442. /* process the buffer, the upper layer will take care of it */
  443. q->first_to_check = add_buf(q->first_to_check, count);
  444. atomic_sub(count, &q->nr_buf_used);
  445. if (q->irq_ptr->perf_stat_enabled)
  446. account_sbals_error(q, count);
  447. break;
  448. case SLSB_CU_INPUT_EMPTY:
  449. case SLSB_P_INPUT_NOT_INIT:
  450. case SLSB_P_INPUT_ACK:
  451. if (q->irq_ptr->perf_stat_enabled)
  452. q->q_stats.nr_sbal_nop++;
  453. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "in nop");
  454. break;
  455. default:
  456. BUG();
  457. }
  458. out:
  459. return q->first_to_check;
  460. }
  461. static int qdio_inbound_q_moved(struct qdio_q *q)
  462. {
  463. int bufnr;
  464. bufnr = get_inbound_buffer_frontier(q);
  465. if ((bufnr != q->last_move) || q->qdio_error) {
  466. q->last_move = bufnr;
  467. if (!is_thinint_irq(q->irq_ptr) && MACHINE_IS_LPAR)
  468. q->u.in.timestamp = get_usecs();
  469. return 1;
  470. } else
  471. return 0;
  472. }
  473. static inline int qdio_inbound_q_done(struct qdio_q *q)
  474. {
  475. unsigned char state = 0;
  476. if (!atomic_read(&q->nr_buf_used))
  477. return 1;
  478. qdio_siga_sync_q(q);
  479. get_buf_state(q, q->first_to_check, &state, 0);
  480. if (state == SLSB_P_INPUT_PRIMED || state == SLSB_P_INPUT_ERROR)
  481. /* more work coming */
  482. return 0;
  483. if (is_thinint_irq(q->irq_ptr))
  484. return 1;
  485. /* don't poll under z/VM */
  486. if (MACHINE_IS_VM)
  487. return 1;
  488. /*
  489. * At this point we know, that inbound first_to_check
  490. * has (probably) not moved (see qdio_inbound_processing).
  491. */
  492. if (get_usecs() > q->u.in.timestamp + QDIO_INPUT_THRESHOLD) {
  493. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "in done:%02x",
  494. q->first_to_check);
  495. return 1;
  496. } else
  497. return 0;
  498. }
  499. static void qdio_kick_handler(struct qdio_q *q)
  500. {
  501. int start = q->first_to_kick;
  502. int end = q->first_to_check;
  503. int count;
  504. if (unlikely(q->irq_ptr->state != QDIO_IRQ_STATE_ACTIVE))
  505. return;
  506. count = sub_buf(end, start);
  507. if (q->is_input_q) {
  508. qperf_inc(q, inbound_handler);
  509. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "kih s:%02x c:%02x", start, count);
  510. } else {
  511. qperf_inc(q, outbound_handler);
  512. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "koh: s:%02x c:%02x",
  513. start, count);
  514. }
  515. q->handler(q->irq_ptr->cdev, q->qdio_error, q->nr, start, count,
  516. q->irq_ptr->int_parm);
  517. /* for the next time */
  518. q->first_to_kick = end;
  519. q->qdio_error = 0;
  520. }
  521. static void __qdio_inbound_processing(struct qdio_q *q)
  522. {
  523. qperf_inc(q, tasklet_inbound);
  524. again:
  525. if (!qdio_inbound_q_moved(q))
  526. return;
  527. qdio_kick_handler(q);
  528. if (!qdio_inbound_q_done(q)) {
  529. /* means poll time is not yet over */
  530. qperf_inc(q, tasklet_inbound_resched);
  531. goto again;
  532. }
  533. qdio_stop_polling(q);
  534. /*
  535. * We need to check again to not lose initiative after
  536. * resetting the ACK state.
  537. */
  538. if (!qdio_inbound_q_done(q)) {
  539. qperf_inc(q, tasklet_inbound_resched2);
  540. goto again;
  541. }
  542. }
  543. void qdio_inbound_processing(unsigned long data)
  544. {
  545. struct qdio_q *q = (struct qdio_q *)data;
  546. __qdio_inbound_processing(q);
  547. }
  548. static int get_outbound_buffer_frontier(struct qdio_q *q)
  549. {
  550. int count, stop;
  551. unsigned char state;
  552. if (((queue_type(q) != QDIO_IQDIO_QFMT) && !pci_out_supported(q)) ||
  553. (queue_type(q) == QDIO_IQDIO_QFMT && multicast_outbound(q)))
  554. qdio_siga_sync_q(q);
  555. /*
  556. * Don't check 128 buffers, as otherwise qdio_inbound_q_moved
  557. * would return 0.
  558. */
  559. count = min(atomic_read(&q->nr_buf_used), QDIO_MAX_BUFFERS_MASK);
  560. stop = add_buf(q->first_to_check, count);
  561. if (q->first_to_check == stop)
  562. return q->first_to_check;
  563. count = get_buf_states(q, q->first_to_check, &state, count, 0);
  564. if (!count)
  565. return q->first_to_check;
  566. switch (state) {
  567. case SLSB_P_OUTPUT_EMPTY:
  568. /* the adapter got it */
  569. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "out empty:%1d %02x", q->nr, count);
  570. atomic_sub(count, &q->nr_buf_used);
  571. q->first_to_check = add_buf(q->first_to_check, count);
  572. if (q->irq_ptr->perf_stat_enabled)
  573. account_sbals(q, count);
  574. break;
  575. case SLSB_P_OUTPUT_ERROR:
  576. announce_buffer_error(q, count);
  577. /* process the buffer, the upper layer will take care of it */
  578. q->first_to_check = add_buf(q->first_to_check, count);
  579. atomic_sub(count, &q->nr_buf_used);
  580. if (q->irq_ptr->perf_stat_enabled)
  581. account_sbals_error(q, count);
  582. break;
  583. case SLSB_CU_OUTPUT_PRIMED:
  584. /* the adapter has not fetched the output yet */
  585. if (q->irq_ptr->perf_stat_enabled)
  586. q->q_stats.nr_sbal_nop++;
  587. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "out primed:%1d", q->nr);
  588. break;
  589. case SLSB_P_OUTPUT_NOT_INIT:
  590. case SLSB_P_OUTPUT_HALTED:
  591. break;
  592. default:
  593. BUG();
  594. }
  595. return q->first_to_check;
  596. }
  597. /* all buffers processed? */
  598. static inline int qdio_outbound_q_done(struct qdio_q *q)
  599. {
  600. return atomic_read(&q->nr_buf_used) == 0;
  601. }
  602. static inline int qdio_outbound_q_moved(struct qdio_q *q)
  603. {
  604. int bufnr;
  605. bufnr = get_outbound_buffer_frontier(q);
  606. if ((bufnr != q->last_move) || q->qdio_error) {
  607. q->last_move = bufnr;
  608. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "out moved:%1d", q->nr);
  609. return 1;
  610. } else
  611. return 0;
  612. }
  613. static int qdio_kick_outbound_q(struct qdio_q *q)
  614. {
  615. unsigned int busy_bit;
  616. int cc;
  617. if (!need_siga_out(q))
  618. return 0;
  619. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "siga-w:%1d", q->nr);
  620. qperf_inc(q, siga_write);
  621. cc = qdio_siga_output(q, &busy_bit);
  622. switch (cc) {
  623. case 0:
  624. break;
  625. case 2:
  626. if (busy_bit) {
  627. DBF_ERROR("%4x cc2 REP:%1d", SCH_NO(q), q->nr);
  628. cc |= QDIO_ERROR_SIGA_BUSY;
  629. } else
  630. DBF_DEV_EVENT(DBF_INFO, q->irq_ptr, "siga-w cc2:%1d", q->nr);
  631. break;
  632. case 1:
  633. case 3:
  634. DBF_ERROR("%4x SIGA-W:%1d", SCH_NO(q), cc);
  635. break;
  636. }
  637. return cc;
  638. }
  639. static void __qdio_outbound_processing(struct qdio_q *q)
  640. {
  641. qperf_inc(q, tasklet_outbound);
  642. BUG_ON(atomic_read(&q->nr_buf_used) < 0);
  643. if (qdio_outbound_q_moved(q))
  644. qdio_kick_handler(q);
  645. if (queue_type(q) == QDIO_ZFCP_QFMT)
  646. if (!pci_out_supported(q) && !qdio_outbound_q_done(q))
  647. goto sched;
  648. /* bail out for HiperSockets unicast queues */
  649. if (queue_type(q) == QDIO_IQDIO_QFMT && !multicast_outbound(q))
  650. return;
  651. if ((queue_type(q) == QDIO_IQDIO_QFMT) &&
  652. (atomic_read(&q->nr_buf_used)) > QDIO_IQDIO_POLL_LVL)
  653. goto sched;
  654. if (q->u.out.pci_out_enabled)
  655. return;
  656. /*
  657. * Now we know that queue type is either qeth without pci enabled
  658. * or HiperSockets multicast. Make sure buffer switch from PRIMED to
  659. * EMPTY is noticed and outbound_handler is called after some time.
  660. */
  661. if (qdio_outbound_q_done(q))
  662. del_timer(&q->u.out.timer);
  663. else
  664. if (!timer_pending(&q->u.out.timer))
  665. mod_timer(&q->u.out.timer, jiffies + 10 * HZ);
  666. return;
  667. sched:
  668. if (unlikely(q->irq_ptr->state == QDIO_IRQ_STATE_STOPPED))
  669. return;
  670. tasklet_schedule(&q->tasklet);
  671. }
  672. /* outbound tasklet */
  673. void qdio_outbound_processing(unsigned long data)
  674. {
  675. struct qdio_q *q = (struct qdio_q *)data;
  676. __qdio_outbound_processing(q);
  677. }
  678. void qdio_outbound_timer(unsigned long data)
  679. {
  680. struct qdio_q *q = (struct qdio_q *)data;
  681. if (unlikely(q->irq_ptr->state == QDIO_IRQ_STATE_STOPPED))
  682. return;
  683. tasklet_schedule(&q->tasklet);
  684. }
  685. static inline void qdio_check_outbound_after_thinint(struct qdio_q *q)
  686. {
  687. struct qdio_q *out;
  688. int i;
  689. if (!pci_out_supported(q))
  690. return;
  691. for_each_output_queue(q->irq_ptr, out, i)
  692. if (!qdio_outbound_q_done(out))
  693. tasklet_schedule(&out->tasklet);
  694. }
  695. static void __tiqdio_inbound_processing(struct qdio_q *q)
  696. {
  697. qperf_inc(q, tasklet_inbound);
  698. qdio_sync_after_thinint(q);
  699. /*
  700. * The interrupt could be caused by a PCI request. Check the
  701. * PCI capable outbound queues.
  702. */
  703. qdio_check_outbound_after_thinint(q);
  704. if (!qdio_inbound_q_moved(q))
  705. return;
  706. qdio_kick_handler(q);
  707. if (!qdio_inbound_q_done(q)) {
  708. qperf_inc(q, tasklet_inbound_resched);
  709. if (likely(q->irq_ptr->state != QDIO_IRQ_STATE_STOPPED)) {
  710. tasklet_schedule(&q->tasklet);
  711. return;
  712. }
  713. }
  714. qdio_stop_polling(q);
  715. /*
  716. * We need to check again to not lose initiative after
  717. * resetting the ACK state.
  718. */
  719. if (!qdio_inbound_q_done(q)) {
  720. qperf_inc(q, tasklet_inbound_resched2);
  721. if (likely(q->irq_ptr->state != QDIO_IRQ_STATE_STOPPED))
  722. tasklet_schedule(&q->tasklet);
  723. }
  724. }
  725. void tiqdio_inbound_processing(unsigned long data)
  726. {
  727. struct qdio_q *q = (struct qdio_q *)data;
  728. __tiqdio_inbound_processing(q);
  729. }
  730. static inline void qdio_set_state(struct qdio_irq *irq_ptr,
  731. enum qdio_irq_states state)
  732. {
  733. DBF_DEV_EVENT(DBF_INFO, irq_ptr, "newstate: %1d", state);
  734. irq_ptr->state = state;
  735. mb();
  736. }
  737. static void qdio_irq_check_sense(struct qdio_irq *irq_ptr, struct irb *irb)
  738. {
  739. if (irb->esw.esw0.erw.cons) {
  740. DBF_ERROR("%4x sense:", irq_ptr->schid.sch_no);
  741. DBF_ERROR_HEX(irb, 64);
  742. DBF_ERROR_HEX(irb->ecw, 64);
  743. }
  744. }
  745. /* PCI interrupt handler */
  746. static void qdio_int_handler_pci(struct qdio_irq *irq_ptr)
  747. {
  748. int i;
  749. struct qdio_q *q;
  750. if (unlikely(irq_ptr->state == QDIO_IRQ_STATE_STOPPED))
  751. return;
  752. for_each_input_queue(irq_ptr, q, i)
  753. tasklet_schedule(&q->tasklet);
  754. if (!(irq_ptr->qib.ac & QIB_AC_OUTBOUND_PCI_SUPPORTED))
  755. return;
  756. for_each_output_queue(irq_ptr, q, i) {
  757. if (qdio_outbound_q_done(q))
  758. continue;
  759. if (!siga_syncs_out_pci(q))
  760. qdio_siga_sync_q(q);
  761. tasklet_schedule(&q->tasklet);
  762. }
  763. }
  764. static void qdio_handle_activate_check(struct ccw_device *cdev,
  765. unsigned long intparm, int cstat, int dstat)
  766. {
  767. struct qdio_irq *irq_ptr = cdev->private->qdio_data;
  768. struct qdio_q *q;
  769. DBF_ERROR("%4x ACT CHECK", irq_ptr->schid.sch_no);
  770. DBF_ERROR("intp :%lx", intparm);
  771. DBF_ERROR("ds: %2x cs:%2x", dstat, cstat);
  772. if (irq_ptr->nr_input_qs) {
  773. q = irq_ptr->input_qs[0];
  774. } else if (irq_ptr->nr_output_qs) {
  775. q = irq_ptr->output_qs[0];
  776. } else {
  777. dump_stack();
  778. goto no_handler;
  779. }
  780. q->handler(q->irq_ptr->cdev, QDIO_ERROR_ACTIVATE_CHECK_CONDITION,
  781. 0, -1, -1, irq_ptr->int_parm);
  782. no_handler:
  783. qdio_set_state(irq_ptr, QDIO_IRQ_STATE_STOPPED);
  784. }
  785. static void qdio_establish_handle_irq(struct ccw_device *cdev, int cstat,
  786. int dstat)
  787. {
  788. struct qdio_irq *irq_ptr = cdev->private->qdio_data;
  789. DBF_DEV_EVENT(DBF_INFO, irq_ptr, "qest irq");
  790. if (cstat)
  791. goto error;
  792. if (dstat & ~(DEV_STAT_DEV_END | DEV_STAT_CHN_END))
  793. goto error;
  794. if (!(dstat & DEV_STAT_DEV_END))
  795. goto error;
  796. qdio_set_state(irq_ptr, QDIO_IRQ_STATE_ESTABLISHED);
  797. return;
  798. error:
  799. DBF_ERROR("%4x EQ:error", irq_ptr->schid.sch_no);
  800. DBF_ERROR("ds: %2x cs:%2x", dstat, cstat);
  801. qdio_set_state(irq_ptr, QDIO_IRQ_STATE_ERR);
  802. }
  803. /* qdio interrupt handler */
  804. void qdio_int_handler(struct ccw_device *cdev, unsigned long intparm,
  805. struct irb *irb)
  806. {
  807. struct qdio_irq *irq_ptr = cdev->private->qdio_data;
  808. int cstat, dstat;
  809. if (!intparm || !irq_ptr) {
  810. DBF_ERROR("qint:%4x", cdev->private->schid.sch_no);
  811. return;
  812. }
  813. if (IS_ERR(irb)) {
  814. switch (PTR_ERR(irb)) {
  815. case -EIO:
  816. DBF_ERROR("%4x IO error", irq_ptr->schid.sch_no);
  817. qdio_set_state(irq_ptr, QDIO_IRQ_STATE_ERR);
  818. wake_up(&cdev->private->wait_q);
  819. return;
  820. default:
  821. WARN_ON(1);
  822. return;
  823. }
  824. }
  825. qdio_irq_check_sense(irq_ptr, irb);
  826. cstat = irb->scsw.cmd.cstat;
  827. dstat = irb->scsw.cmd.dstat;
  828. switch (irq_ptr->state) {
  829. case QDIO_IRQ_STATE_INACTIVE:
  830. qdio_establish_handle_irq(cdev, cstat, dstat);
  831. break;
  832. case QDIO_IRQ_STATE_CLEANUP:
  833. qdio_set_state(irq_ptr, QDIO_IRQ_STATE_INACTIVE);
  834. break;
  835. case QDIO_IRQ_STATE_ESTABLISHED:
  836. case QDIO_IRQ_STATE_ACTIVE:
  837. if (cstat & SCHN_STAT_PCI) {
  838. qdio_int_handler_pci(irq_ptr);
  839. return;
  840. }
  841. if (cstat || dstat)
  842. qdio_handle_activate_check(cdev, intparm, cstat,
  843. dstat);
  844. break;
  845. case QDIO_IRQ_STATE_STOPPED:
  846. break;
  847. default:
  848. WARN_ON(1);
  849. }
  850. wake_up(&cdev->private->wait_q);
  851. }
  852. /**
  853. * qdio_get_ssqd_desc - get qdio subchannel description
  854. * @cdev: ccw device to get description for
  855. * @data: where to store the ssqd
  856. *
  857. * Returns 0 or an error code. The results of the chsc are stored in the
  858. * specified structure.
  859. */
  860. int qdio_get_ssqd_desc(struct ccw_device *cdev,
  861. struct qdio_ssqd_desc *data)
  862. {
  863. if (!cdev || !cdev->private)
  864. return -EINVAL;
  865. DBF_EVENT("get ssqd:%4x", cdev->private->schid.sch_no);
  866. return qdio_setup_get_ssqd(NULL, &cdev->private->schid, data);
  867. }
  868. EXPORT_SYMBOL_GPL(qdio_get_ssqd_desc);
  869. /**
  870. * qdio_cleanup - shutdown queues and free data structures
  871. * @cdev: associated ccw device
  872. * @how: use halt or clear to shutdown
  873. *
  874. * This function calls qdio_shutdown() for @cdev with method @how.
  875. * and qdio_free(). The qdio_free() return value is ignored since
  876. * !irq_ptr is already checked.
  877. */
  878. int qdio_cleanup(struct ccw_device *cdev, int how)
  879. {
  880. struct qdio_irq *irq_ptr = cdev->private->qdio_data;
  881. int rc;
  882. if (!irq_ptr)
  883. return -ENODEV;
  884. rc = qdio_shutdown(cdev, how);
  885. qdio_free(cdev);
  886. return rc;
  887. }
  888. EXPORT_SYMBOL_GPL(qdio_cleanup);
  889. static void qdio_shutdown_queues(struct ccw_device *cdev)
  890. {
  891. struct qdio_irq *irq_ptr = cdev->private->qdio_data;
  892. struct qdio_q *q;
  893. int i;
  894. for_each_input_queue(irq_ptr, q, i)
  895. tasklet_kill(&q->tasklet);
  896. for_each_output_queue(irq_ptr, q, i) {
  897. del_timer(&q->u.out.timer);
  898. tasklet_kill(&q->tasklet);
  899. }
  900. }
  901. /**
  902. * qdio_shutdown - shut down a qdio subchannel
  903. * @cdev: associated ccw device
  904. * @how: use halt or clear to shutdown
  905. */
  906. int qdio_shutdown(struct ccw_device *cdev, int how)
  907. {
  908. struct qdio_irq *irq_ptr = cdev->private->qdio_data;
  909. int rc;
  910. unsigned long flags;
  911. if (!irq_ptr)
  912. return -ENODEV;
  913. BUG_ON(irqs_disabled());
  914. DBF_EVENT("qshutdown:%4x", cdev->private->schid.sch_no);
  915. mutex_lock(&irq_ptr->setup_mutex);
  916. /*
  917. * Subchannel was already shot down. We cannot prevent being called
  918. * twice since cio may trigger a shutdown asynchronously.
  919. */
  920. if (irq_ptr->state == QDIO_IRQ_STATE_INACTIVE) {
  921. mutex_unlock(&irq_ptr->setup_mutex);
  922. return 0;
  923. }
  924. /*
  925. * Indicate that the device is going down. Scheduling the queue
  926. * tasklets is forbidden from here on.
  927. */
  928. qdio_set_state(irq_ptr, QDIO_IRQ_STATE_STOPPED);
  929. tiqdio_remove_input_queues(irq_ptr);
  930. qdio_shutdown_queues(cdev);
  931. qdio_shutdown_debug_entries(irq_ptr, cdev);
  932. /* cleanup subchannel */
  933. spin_lock_irqsave(get_ccwdev_lock(cdev), flags);
  934. if (how & QDIO_FLAG_CLEANUP_USING_CLEAR)
  935. rc = ccw_device_clear(cdev, QDIO_DOING_CLEANUP);
  936. else
  937. /* default behaviour is halt */
  938. rc = ccw_device_halt(cdev, QDIO_DOING_CLEANUP);
  939. if (rc) {
  940. DBF_ERROR("%4x SHUTD ERR", irq_ptr->schid.sch_no);
  941. DBF_ERROR("rc:%4d", rc);
  942. goto no_cleanup;
  943. }
  944. qdio_set_state(irq_ptr, QDIO_IRQ_STATE_CLEANUP);
  945. spin_unlock_irqrestore(get_ccwdev_lock(cdev), flags);
  946. wait_event_interruptible_timeout(cdev->private->wait_q,
  947. irq_ptr->state == QDIO_IRQ_STATE_INACTIVE ||
  948. irq_ptr->state == QDIO_IRQ_STATE_ERR,
  949. 10 * HZ);
  950. spin_lock_irqsave(get_ccwdev_lock(cdev), flags);
  951. no_cleanup:
  952. qdio_shutdown_thinint(irq_ptr);
  953. /* restore interrupt handler */
  954. if ((void *)cdev->handler == (void *)qdio_int_handler)
  955. cdev->handler = irq_ptr->orig_handler;
  956. spin_unlock_irqrestore(get_ccwdev_lock(cdev), flags);
  957. qdio_set_state(irq_ptr, QDIO_IRQ_STATE_INACTIVE);
  958. mutex_unlock(&irq_ptr->setup_mutex);
  959. if (rc)
  960. return rc;
  961. return 0;
  962. }
  963. EXPORT_SYMBOL_GPL(qdio_shutdown);
  964. /**
  965. * qdio_free - free data structures for a qdio subchannel
  966. * @cdev: associated ccw device
  967. */
  968. int qdio_free(struct ccw_device *cdev)
  969. {
  970. struct qdio_irq *irq_ptr = cdev->private->qdio_data;
  971. if (!irq_ptr)
  972. return -ENODEV;
  973. DBF_EVENT("qfree:%4x", cdev->private->schid.sch_no);
  974. mutex_lock(&irq_ptr->setup_mutex);
  975. if (irq_ptr->debug_area != NULL) {
  976. debug_unregister(irq_ptr->debug_area);
  977. irq_ptr->debug_area = NULL;
  978. }
  979. cdev->private->qdio_data = NULL;
  980. mutex_unlock(&irq_ptr->setup_mutex);
  981. qdio_release_memory(irq_ptr);
  982. return 0;
  983. }
  984. EXPORT_SYMBOL_GPL(qdio_free);
  985. /**
  986. * qdio_initialize - allocate and establish queues for a qdio subchannel
  987. * @init_data: initialization data
  988. *
  989. * This function first allocates queues via qdio_allocate() and on success
  990. * establishes them via qdio_establish().
  991. */
  992. int qdio_initialize(struct qdio_initialize *init_data)
  993. {
  994. int rc;
  995. rc = qdio_allocate(init_data);
  996. if (rc)
  997. return rc;
  998. rc = qdio_establish(init_data);
  999. if (rc)
  1000. qdio_free(init_data->cdev);
  1001. return rc;
  1002. }
  1003. EXPORT_SYMBOL_GPL(qdio_initialize);
  1004. /**
  1005. * qdio_allocate - allocate qdio queues and associated data
  1006. * @init_data: initialization data
  1007. */
  1008. int qdio_allocate(struct qdio_initialize *init_data)
  1009. {
  1010. struct qdio_irq *irq_ptr;
  1011. DBF_EVENT("qallocate:%4x", init_data->cdev->private->schid.sch_no);
  1012. if ((init_data->no_input_qs && !init_data->input_handler) ||
  1013. (init_data->no_output_qs && !init_data->output_handler))
  1014. return -EINVAL;
  1015. if ((init_data->no_input_qs > QDIO_MAX_QUEUES_PER_IRQ) ||
  1016. (init_data->no_output_qs > QDIO_MAX_QUEUES_PER_IRQ))
  1017. return -EINVAL;
  1018. if ((!init_data->input_sbal_addr_array) ||
  1019. (!init_data->output_sbal_addr_array))
  1020. return -EINVAL;
  1021. /* irq_ptr must be in GFP_DMA since it contains ccw1.cda */
  1022. irq_ptr = (void *) get_zeroed_page(GFP_KERNEL | GFP_DMA);
  1023. if (!irq_ptr)
  1024. goto out_err;
  1025. mutex_init(&irq_ptr->setup_mutex);
  1026. qdio_allocate_dbf(init_data, irq_ptr);
  1027. /*
  1028. * Allocate a page for the chsc calls in qdio_establish.
  1029. * Must be pre-allocated since a zfcp recovery will call
  1030. * qdio_establish. In case of low memory and swap on a zfcp disk
  1031. * we may not be able to allocate memory otherwise.
  1032. */
  1033. irq_ptr->chsc_page = get_zeroed_page(GFP_KERNEL);
  1034. if (!irq_ptr->chsc_page)
  1035. goto out_rel;
  1036. /* qdr is used in ccw1.cda which is u32 */
  1037. irq_ptr->qdr = (struct qdr *) get_zeroed_page(GFP_KERNEL | GFP_DMA);
  1038. if (!irq_ptr->qdr)
  1039. goto out_rel;
  1040. WARN_ON((unsigned long)irq_ptr->qdr & 0xfff);
  1041. if (qdio_allocate_qs(irq_ptr, init_data->no_input_qs,
  1042. init_data->no_output_qs))
  1043. goto out_rel;
  1044. init_data->cdev->private->qdio_data = irq_ptr;
  1045. qdio_set_state(irq_ptr, QDIO_IRQ_STATE_INACTIVE);
  1046. return 0;
  1047. out_rel:
  1048. qdio_release_memory(irq_ptr);
  1049. out_err:
  1050. return -ENOMEM;
  1051. }
  1052. EXPORT_SYMBOL_GPL(qdio_allocate);
  1053. /**
  1054. * qdio_establish - establish queues on a qdio subchannel
  1055. * @init_data: initialization data
  1056. */
  1057. int qdio_establish(struct qdio_initialize *init_data)
  1058. {
  1059. struct qdio_irq *irq_ptr;
  1060. struct ccw_device *cdev = init_data->cdev;
  1061. unsigned long saveflags;
  1062. int rc;
  1063. DBF_EVENT("qestablish:%4x", cdev->private->schid.sch_no);
  1064. irq_ptr = cdev->private->qdio_data;
  1065. if (!irq_ptr)
  1066. return -ENODEV;
  1067. if (cdev->private->state != DEV_STATE_ONLINE)
  1068. return -EINVAL;
  1069. mutex_lock(&irq_ptr->setup_mutex);
  1070. qdio_setup_irq(init_data);
  1071. rc = qdio_establish_thinint(irq_ptr);
  1072. if (rc) {
  1073. mutex_unlock(&irq_ptr->setup_mutex);
  1074. qdio_shutdown(cdev, QDIO_FLAG_CLEANUP_USING_CLEAR);
  1075. return rc;
  1076. }
  1077. /* establish q */
  1078. irq_ptr->ccw.cmd_code = irq_ptr->equeue.cmd;
  1079. irq_ptr->ccw.flags = CCW_FLAG_SLI;
  1080. irq_ptr->ccw.count = irq_ptr->equeue.count;
  1081. irq_ptr->ccw.cda = (u32)((addr_t)irq_ptr->qdr);
  1082. spin_lock_irqsave(get_ccwdev_lock(cdev), saveflags);
  1083. ccw_device_set_options_mask(cdev, 0);
  1084. rc = ccw_device_start(cdev, &irq_ptr->ccw, QDIO_DOING_ESTABLISH, 0, 0);
  1085. if (rc) {
  1086. DBF_ERROR("%4x est IO ERR", irq_ptr->schid.sch_no);
  1087. DBF_ERROR("rc:%4x", rc);
  1088. }
  1089. spin_unlock_irqrestore(get_ccwdev_lock(cdev), saveflags);
  1090. if (rc) {
  1091. mutex_unlock(&irq_ptr->setup_mutex);
  1092. qdio_shutdown(cdev, QDIO_FLAG_CLEANUP_USING_CLEAR);
  1093. return rc;
  1094. }
  1095. wait_event_interruptible_timeout(cdev->private->wait_q,
  1096. irq_ptr->state == QDIO_IRQ_STATE_ESTABLISHED ||
  1097. irq_ptr->state == QDIO_IRQ_STATE_ERR, HZ);
  1098. if (irq_ptr->state != QDIO_IRQ_STATE_ESTABLISHED) {
  1099. mutex_unlock(&irq_ptr->setup_mutex);
  1100. qdio_shutdown(cdev, QDIO_FLAG_CLEANUP_USING_CLEAR);
  1101. return -EIO;
  1102. }
  1103. qdio_setup_ssqd_info(irq_ptr);
  1104. DBF_EVENT("qDmmwc:%2x", irq_ptr->ssqd_desc.mmwc);
  1105. DBF_EVENT("qib ac:%4x", irq_ptr->qib.ac);
  1106. /* qebsm is now setup if available, initialize buffer states */
  1107. qdio_init_buf_states(irq_ptr);
  1108. mutex_unlock(&irq_ptr->setup_mutex);
  1109. qdio_print_subchannel_info(irq_ptr, cdev);
  1110. qdio_setup_debug_entries(irq_ptr, cdev);
  1111. return 0;
  1112. }
  1113. EXPORT_SYMBOL_GPL(qdio_establish);
  1114. /**
  1115. * qdio_activate - activate queues on a qdio subchannel
  1116. * @cdev: associated cdev
  1117. */
  1118. int qdio_activate(struct ccw_device *cdev)
  1119. {
  1120. struct qdio_irq *irq_ptr;
  1121. int rc;
  1122. unsigned long saveflags;
  1123. DBF_EVENT("qactivate:%4x", cdev->private->schid.sch_no);
  1124. irq_ptr = cdev->private->qdio_data;
  1125. if (!irq_ptr)
  1126. return -ENODEV;
  1127. if (cdev->private->state != DEV_STATE_ONLINE)
  1128. return -EINVAL;
  1129. mutex_lock(&irq_ptr->setup_mutex);
  1130. if (irq_ptr->state == QDIO_IRQ_STATE_INACTIVE) {
  1131. rc = -EBUSY;
  1132. goto out;
  1133. }
  1134. irq_ptr->ccw.cmd_code = irq_ptr->aqueue.cmd;
  1135. irq_ptr->ccw.flags = CCW_FLAG_SLI;
  1136. irq_ptr->ccw.count = irq_ptr->aqueue.count;
  1137. irq_ptr->ccw.cda = 0;
  1138. spin_lock_irqsave(get_ccwdev_lock(cdev), saveflags);
  1139. ccw_device_set_options(cdev, CCWDEV_REPORT_ALL);
  1140. rc = ccw_device_start(cdev, &irq_ptr->ccw, QDIO_DOING_ACTIVATE,
  1141. 0, DOIO_DENY_PREFETCH);
  1142. if (rc) {
  1143. DBF_ERROR("%4x act IO ERR", irq_ptr->schid.sch_no);
  1144. DBF_ERROR("rc:%4x", rc);
  1145. }
  1146. spin_unlock_irqrestore(get_ccwdev_lock(cdev), saveflags);
  1147. if (rc)
  1148. goto out;
  1149. if (is_thinint_irq(irq_ptr))
  1150. tiqdio_add_input_queues(irq_ptr);
  1151. /* wait for subchannel to become active */
  1152. msleep(5);
  1153. switch (irq_ptr->state) {
  1154. case QDIO_IRQ_STATE_STOPPED:
  1155. case QDIO_IRQ_STATE_ERR:
  1156. rc = -EIO;
  1157. break;
  1158. default:
  1159. qdio_set_state(irq_ptr, QDIO_IRQ_STATE_ACTIVE);
  1160. rc = 0;
  1161. }
  1162. out:
  1163. mutex_unlock(&irq_ptr->setup_mutex);
  1164. return rc;
  1165. }
  1166. EXPORT_SYMBOL_GPL(qdio_activate);
  1167. static inline int buf_in_between(int bufnr, int start, int count)
  1168. {
  1169. int end = add_buf(start, count);
  1170. if (end > start) {
  1171. if (bufnr >= start && bufnr < end)
  1172. return 1;
  1173. else
  1174. return 0;
  1175. }
  1176. /* wrap-around case */
  1177. if ((bufnr >= start && bufnr <= QDIO_MAX_BUFFERS_PER_Q) ||
  1178. (bufnr < end))
  1179. return 1;
  1180. else
  1181. return 0;
  1182. }
  1183. /**
  1184. * handle_inbound - reset processed input buffers
  1185. * @q: queue containing the buffers
  1186. * @callflags: flags
  1187. * @bufnr: first buffer to process
  1188. * @count: how many buffers are emptied
  1189. */
  1190. static int handle_inbound(struct qdio_q *q, unsigned int callflags,
  1191. int bufnr, int count)
  1192. {
  1193. int used, diff;
  1194. qperf_inc(q, inbound_call);
  1195. if (!q->u.in.polling)
  1196. goto set;
  1197. /* protect against stop polling setting an ACK for an emptied slsb */
  1198. if (count == QDIO_MAX_BUFFERS_PER_Q) {
  1199. /* overwriting everything, just delete polling status */
  1200. q->u.in.polling = 0;
  1201. q->u.in.ack_count = 0;
  1202. goto set;
  1203. } else if (buf_in_between(q->u.in.ack_start, bufnr, count)) {
  1204. if (is_qebsm(q)) {
  1205. /* partial overwrite, just update ack_start */
  1206. diff = add_buf(bufnr, count);
  1207. diff = sub_buf(diff, q->u.in.ack_start);
  1208. q->u.in.ack_count -= diff;
  1209. if (q->u.in.ack_count <= 0) {
  1210. q->u.in.polling = 0;
  1211. q->u.in.ack_count = 0;
  1212. goto set;
  1213. }
  1214. q->u.in.ack_start = add_buf(q->u.in.ack_start, diff);
  1215. }
  1216. else
  1217. /* the only ACK will be deleted, so stop polling */
  1218. q->u.in.polling = 0;
  1219. }
  1220. set:
  1221. count = set_buf_states(q, bufnr, SLSB_CU_INPUT_EMPTY, count);
  1222. used = atomic_add_return(count, &q->nr_buf_used) - count;
  1223. BUG_ON(used + count > QDIO_MAX_BUFFERS_PER_Q);
  1224. /* no need to signal as long as the adapter had free buffers */
  1225. if (used)
  1226. return 0;
  1227. if (need_siga_in(q))
  1228. return qdio_siga_input(q);
  1229. return 0;
  1230. }
  1231. /**
  1232. * handle_outbound - process filled outbound buffers
  1233. * @q: queue containing the buffers
  1234. * @callflags: flags
  1235. * @bufnr: first buffer to process
  1236. * @count: how many buffers are filled
  1237. */
  1238. static int handle_outbound(struct qdio_q *q, unsigned int callflags,
  1239. int bufnr, int count)
  1240. {
  1241. unsigned char state;
  1242. int used, rc = 0;
  1243. qperf_inc(q, outbound_call);
  1244. count = set_buf_states(q, bufnr, SLSB_CU_OUTPUT_PRIMED, count);
  1245. used = atomic_add_return(count, &q->nr_buf_used);
  1246. BUG_ON(used > QDIO_MAX_BUFFERS_PER_Q);
  1247. if (callflags & QDIO_FLAG_PCI_OUT) {
  1248. q->u.out.pci_out_enabled = 1;
  1249. qperf_inc(q, pci_request_int);
  1250. }
  1251. else
  1252. q->u.out.pci_out_enabled = 0;
  1253. if (queue_type(q) == QDIO_IQDIO_QFMT) {
  1254. if (multicast_outbound(q))
  1255. rc = qdio_kick_outbound_q(q);
  1256. else
  1257. if ((q->irq_ptr->ssqd_desc.mmwc > 1) &&
  1258. (count > 1) &&
  1259. (count <= q->irq_ptr->ssqd_desc.mmwc)) {
  1260. /* exploit enhanced SIGA */
  1261. q->u.out.use_enh_siga = 1;
  1262. rc = qdio_kick_outbound_q(q);
  1263. } else {
  1264. /*
  1265. * One siga-w per buffer required for unicast
  1266. * HiperSockets.
  1267. */
  1268. q->u.out.use_enh_siga = 0;
  1269. while (count--) {
  1270. rc = qdio_kick_outbound_q(q);
  1271. if (rc)
  1272. goto out;
  1273. }
  1274. }
  1275. goto out;
  1276. }
  1277. if (need_siga_sync(q)) {
  1278. qdio_siga_sync_q(q);
  1279. goto out;
  1280. }
  1281. /* try to fast requeue buffers */
  1282. get_buf_state(q, prev_buf(bufnr), &state, 0);
  1283. if (state != SLSB_CU_OUTPUT_PRIMED)
  1284. rc = qdio_kick_outbound_q(q);
  1285. else
  1286. qperf_inc(q, fast_requeue);
  1287. out:
  1288. tasklet_schedule(&q->tasklet);
  1289. return rc;
  1290. }
  1291. /**
  1292. * do_QDIO - process input or output buffers
  1293. * @cdev: associated ccw_device for the qdio subchannel
  1294. * @callflags: input or output and special flags from the program
  1295. * @q_nr: queue number
  1296. * @bufnr: buffer number
  1297. * @count: how many buffers to process
  1298. */
  1299. int do_QDIO(struct ccw_device *cdev, unsigned int callflags,
  1300. int q_nr, unsigned int bufnr, unsigned int count)
  1301. {
  1302. struct qdio_irq *irq_ptr;
  1303. if (bufnr >= QDIO_MAX_BUFFERS_PER_Q || count > QDIO_MAX_BUFFERS_PER_Q)
  1304. return -EINVAL;
  1305. irq_ptr = cdev->private->qdio_data;
  1306. if (!irq_ptr)
  1307. return -ENODEV;
  1308. DBF_DEV_EVENT(DBF_INFO, irq_ptr,
  1309. "do%02x b:%02x c:%02x", callflags, bufnr, count);
  1310. if (irq_ptr->state != QDIO_IRQ_STATE_ACTIVE)
  1311. return -EBUSY;
  1312. if (callflags & QDIO_FLAG_SYNC_INPUT)
  1313. return handle_inbound(irq_ptr->input_qs[q_nr],
  1314. callflags, bufnr, count);
  1315. else if (callflags & QDIO_FLAG_SYNC_OUTPUT)
  1316. return handle_outbound(irq_ptr->output_qs[q_nr],
  1317. callflags, bufnr, count);
  1318. return -EINVAL;
  1319. }
  1320. EXPORT_SYMBOL_GPL(do_QDIO);
  1321. static int __init init_QDIO(void)
  1322. {
  1323. int rc;
  1324. rc = qdio_setup_init();
  1325. if (rc)
  1326. return rc;
  1327. rc = tiqdio_allocate_memory();
  1328. if (rc)
  1329. goto out_cache;
  1330. rc = qdio_debug_init();
  1331. if (rc)
  1332. goto out_ti;
  1333. rc = tiqdio_register_thinints();
  1334. if (rc)
  1335. goto out_debug;
  1336. return 0;
  1337. out_debug:
  1338. qdio_debug_exit();
  1339. out_ti:
  1340. tiqdio_free_memory();
  1341. out_cache:
  1342. qdio_setup_exit();
  1343. return rc;
  1344. }
  1345. static void __exit exit_QDIO(void)
  1346. {
  1347. tiqdio_unregister_thinints();
  1348. tiqdio_free_memory();
  1349. qdio_debug_exit();
  1350. qdio_setup_exit();
  1351. }
  1352. module_init(init_QDIO);
  1353. module_exit(exit_QDIO);