qdio_main.c 41 KB

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