chsc_sch.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873
  1. /*
  2. * Driver for s390 chsc subchannels
  3. *
  4. * Copyright IBM Corp. 2008, 2011
  5. *
  6. * Author(s): Cornelia Huck <cornelia.huck@de.ibm.com>
  7. *
  8. */
  9. #include <linux/slab.h>
  10. #include <linux/compat.h>
  11. #include <linux/device.h>
  12. #include <linux/module.h>
  13. #include <linux/uaccess.h>
  14. #include <linux/miscdevice.h>
  15. #include <linux/kernel_stat.h>
  16. #include <asm/compat.h>
  17. #include <asm/cio.h>
  18. #include <asm/chsc.h>
  19. #include <asm/isc.h>
  20. #include "cio.h"
  21. #include "cio_debug.h"
  22. #include "css.h"
  23. #include "chsc_sch.h"
  24. #include "ioasm.h"
  25. static debug_info_t *chsc_debug_msg_id;
  26. static debug_info_t *chsc_debug_log_id;
  27. #define CHSC_MSG(imp, args...) do { \
  28. debug_sprintf_event(chsc_debug_msg_id, imp , ##args); \
  29. } while (0)
  30. #define CHSC_LOG(imp, txt) do { \
  31. debug_text_event(chsc_debug_log_id, imp , txt); \
  32. } while (0)
  33. static void CHSC_LOG_HEX(int level, void *data, int length)
  34. {
  35. while (length > 0) {
  36. debug_event(chsc_debug_log_id, level, data, length);
  37. length -= chsc_debug_log_id->buf_size;
  38. data += chsc_debug_log_id->buf_size;
  39. }
  40. }
  41. MODULE_AUTHOR("IBM Corporation");
  42. MODULE_DESCRIPTION("driver for s390 chsc subchannels");
  43. MODULE_LICENSE("GPL");
  44. static void chsc_subchannel_irq(struct subchannel *sch)
  45. {
  46. struct chsc_private *private = dev_get_drvdata(&sch->dev);
  47. struct chsc_request *request = private->request;
  48. struct irb *irb = (struct irb *)&S390_lowcore.irb;
  49. CHSC_LOG(4, "irb");
  50. CHSC_LOG_HEX(4, irb, sizeof(*irb));
  51. kstat_cpu(smp_processor_id()).irqs[IOINT_CSC]++;
  52. /* Copy irb to provided request and set done. */
  53. if (!request) {
  54. CHSC_MSG(0, "Interrupt on sch 0.%x.%04x with no request\n",
  55. sch->schid.ssid, sch->schid.sch_no);
  56. return;
  57. }
  58. private->request = NULL;
  59. memcpy(&request->irb, irb, sizeof(*irb));
  60. cio_update_schib(sch);
  61. complete(&request->completion);
  62. put_device(&sch->dev);
  63. }
  64. static int chsc_subchannel_probe(struct subchannel *sch)
  65. {
  66. struct chsc_private *private;
  67. int ret;
  68. CHSC_MSG(6, "Detected chsc subchannel 0.%x.%04x\n",
  69. sch->schid.ssid, sch->schid.sch_no);
  70. sch->isc = CHSC_SCH_ISC;
  71. private = kzalloc(sizeof(*private), GFP_KERNEL);
  72. if (!private)
  73. return -ENOMEM;
  74. dev_set_drvdata(&sch->dev, private);
  75. ret = cio_enable_subchannel(sch, (u32)(unsigned long)sch);
  76. if (ret) {
  77. CHSC_MSG(0, "Failed to enable 0.%x.%04x: %d\n",
  78. sch->schid.ssid, sch->schid.sch_no, ret);
  79. dev_set_drvdata(&sch->dev, NULL);
  80. kfree(private);
  81. } else {
  82. if (dev_get_uevent_suppress(&sch->dev)) {
  83. dev_set_uevent_suppress(&sch->dev, 0);
  84. kobject_uevent(&sch->dev.kobj, KOBJ_ADD);
  85. }
  86. }
  87. return ret;
  88. }
  89. static int chsc_subchannel_remove(struct subchannel *sch)
  90. {
  91. struct chsc_private *private;
  92. cio_disable_subchannel(sch);
  93. private = dev_get_drvdata(&sch->dev);
  94. dev_set_drvdata(&sch->dev, NULL);
  95. if (private->request) {
  96. complete(&private->request->completion);
  97. put_device(&sch->dev);
  98. }
  99. kfree(private);
  100. return 0;
  101. }
  102. static void chsc_subchannel_shutdown(struct subchannel *sch)
  103. {
  104. cio_disable_subchannel(sch);
  105. }
  106. static int chsc_subchannel_prepare(struct subchannel *sch)
  107. {
  108. int cc;
  109. struct schib schib;
  110. /*
  111. * Don't allow suspend while the subchannel is not idle
  112. * since we don't have a way to clear the subchannel and
  113. * cannot disable it with a request running.
  114. */
  115. cc = stsch_err(sch->schid, &schib);
  116. if (!cc && scsw_stctl(&schib.scsw))
  117. return -EAGAIN;
  118. return 0;
  119. }
  120. static int chsc_subchannel_freeze(struct subchannel *sch)
  121. {
  122. return cio_disable_subchannel(sch);
  123. }
  124. static int chsc_subchannel_restore(struct subchannel *sch)
  125. {
  126. return cio_enable_subchannel(sch, (u32)(unsigned long)sch);
  127. }
  128. static struct css_device_id chsc_subchannel_ids[] = {
  129. { .match_flags = 0x1, .type =SUBCHANNEL_TYPE_CHSC, },
  130. { /* end of list */ },
  131. };
  132. MODULE_DEVICE_TABLE(css, chsc_subchannel_ids);
  133. static struct css_driver chsc_subchannel_driver = {
  134. .drv = {
  135. .owner = THIS_MODULE,
  136. .name = "chsc_subchannel",
  137. },
  138. .subchannel_type = chsc_subchannel_ids,
  139. .irq = chsc_subchannel_irq,
  140. .probe = chsc_subchannel_probe,
  141. .remove = chsc_subchannel_remove,
  142. .shutdown = chsc_subchannel_shutdown,
  143. .prepare = chsc_subchannel_prepare,
  144. .freeze = chsc_subchannel_freeze,
  145. .thaw = chsc_subchannel_restore,
  146. .restore = chsc_subchannel_restore,
  147. };
  148. static int __init chsc_init_dbfs(void)
  149. {
  150. chsc_debug_msg_id = debug_register("chsc_msg", 16, 1,
  151. 16 * sizeof(long));
  152. if (!chsc_debug_msg_id)
  153. goto out;
  154. debug_register_view(chsc_debug_msg_id, &debug_sprintf_view);
  155. debug_set_level(chsc_debug_msg_id, 2);
  156. chsc_debug_log_id = debug_register("chsc_log", 16, 1, 16);
  157. if (!chsc_debug_log_id)
  158. goto out;
  159. debug_register_view(chsc_debug_log_id, &debug_hex_ascii_view);
  160. debug_set_level(chsc_debug_log_id, 2);
  161. return 0;
  162. out:
  163. if (chsc_debug_msg_id)
  164. debug_unregister(chsc_debug_msg_id);
  165. return -ENOMEM;
  166. }
  167. static void chsc_remove_dbfs(void)
  168. {
  169. debug_unregister(chsc_debug_log_id);
  170. debug_unregister(chsc_debug_msg_id);
  171. }
  172. static int __init chsc_init_sch_driver(void)
  173. {
  174. return css_driver_register(&chsc_subchannel_driver);
  175. }
  176. static void chsc_cleanup_sch_driver(void)
  177. {
  178. css_driver_unregister(&chsc_subchannel_driver);
  179. }
  180. static DEFINE_SPINLOCK(chsc_lock);
  181. static int chsc_subchannel_match_next_free(struct device *dev, void *data)
  182. {
  183. struct subchannel *sch = to_subchannel(dev);
  184. return sch->schib.pmcw.ena && !scsw_fctl(&sch->schib.scsw);
  185. }
  186. static struct subchannel *chsc_get_next_subchannel(struct subchannel *sch)
  187. {
  188. struct device *dev;
  189. dev = driver_find_device(&chsc_subchannel_driver.drv,
  190. sch ? &sch->dev : NULL, NULL,
  191. chsc_subchannel_match_next_free);
  192. return dev ? to_subchannel(dev) : NULL;
  193. }
  194. /**
  195. * chsc_async() - try to start a chsc request asynchronously
  196. * @chsc_area: request to be started
  197. * @request: request structure to associate
  198. *
  199. * Tries to start a chsc request on one of the existing chsc subchannels.
  200. * Returns:
  201. * %0 if the request was performed synchronously
  202. * %-EINPROGRESS if the request was successfully started
  203. * %-EBUSY if all chsc subchannels are busy
  204. * %-ENODEV if no chsc subchannels are available
  205. * Context:
  206. * interrupts disabled, chsc_lock held
  207. */
  208. static int chsc_async(struct chsc_async_area *chsc_area,
  209. struct chsc_request *request)
  210. {
  211. int cc;
  212. struct chsc_private *private;
  213. struct subchannel *sch = NULL;
  214. int ret = -ENODEV;
  215. char dbf[10];
  216. chsc_area->header.key = PAGE_DEFAULT_KEY >> 4;
  217. while ((sch = chsc_get_next_subchannel(sch))) {
  218. spin_lock(sch->lock);
  219. private = dev_get_drvdata(&sch->dev);
  220. if (private->request) {
  221. spin_unlock(sch->lock);
  222. ret = -EBUSY;
  223. continue;
  224. }
  225. chsc_area->header.sid = sch->schid;
  226. CHSC_LOG(2, "schid");
  227. CHSC_LOG_HEX(2, &sch->schid, sizeof(sch->schid));
  228. cc = chsc(chsc_area);
  229. sprintf(dbf, "cc:%d", cc);
  230. CHSC_LOG(2, dbf);
  231. switch (cc) {
  232. case 0:
  233. ret = 0;
  234. break;
  235. case 1:
  236. sch->schib.scsw.cmd.fctl |= SCSW_FCTL_START_FUNC;
  237. ret = -EINPROGRESS;
  238. private->request = request;
  239. break;
  240. case 2:
  241. ret = -EBUSY;
  242. break;
  243. default:
  244. ret = -ENODEV;
  245. }
  246. spin_unlock(sch->lock);
  247. CHSC_MSG(2, "chsc on 0.%x.%04x returned cc=%d\n",
  248. sch->schid.ssid, sch->schid.sch_no, cc);
  249. if (ret == -EINPROGRESS)
  250. return -EINPROGRESS;
  251. put_device(&sch->dev);
  252. if (ret == 0)
  253. return 0;
  254. }
  255. return ret;
  256. }
  257. static void chsc_log_command(struct chsc_async_area *chsc_area)
  258. {
  259. char dbf[10];
  260. sprintf(dbf, "CHSC:%x", chsc_area->header.code);
  261. CHSC_LOG(0, dbf);
  262. CHSC_LOG_HEX(0, chsc_area, 32);
  263. }
  264. static int chsc_examine_irb(struct chsc_request *request)
  265. {
  266. int backed_up;
  267. if (!(scsw_stctl(&request->irb.scsw) & SCSW_STCTL_STATUS_PEND))
  268. return -EIO;
  269. backed_up = scsw_cstat(&request->irb.scsw) & SCHN_STAT_CHAIN_CHECK;
  270. request->irb.scsw.cmd.cstat &= ~SCHN_STAT_CHAIN_CHECK;
  271. if (scsw_cstat(&request->irb.scsw) == 0)
  272. return 0;
  273. if (!backed_up)
  274. return 0;
  275. if (scsw_cstat(&request->irb.scsw) & SCHN_STAT_PROG_CHECK)
  276. return -EIO;
  277. if (scsw_cstat(&request->irb.scsw) & SCHN_STAT_PROT_CHECK)
  278. return -EPERM;
  279. if (scsw_cstat(&request->irb.scsw) & SCHN_STAT_CHN_DATA_CHK)
  280. return -EAGAIN;
  281. if (scsw_cstat(&request->irb.scsw) & SCHN_STAT_CHN_CTRL_CHK)
  282. return -EAGAIN;
  283. return -EIO;
  284. }
  285. static int chsc_ioctl_start(void __user *user_area)
  286. {
  287. struct chsc_request *request;
  288. struct chsc_async_area *chsc_area;
  289. int ret;
  290. char dbf[10];
  291. if (!css_general_characteristics.dynio)
  292. /* It makes no sense to try. */
  293. return -EOPNOTSUPP;
  294. chsc_area = (void *)get_zeroed_page(GFP_DMA | GFP_KERNEL);
  295. if (!chsc_area)
  296. return -ENOMEM;
  297. request = kzalloc(sizeof(*request), GFP_KERNEL);
  298. if (!request) {
  299. ret = -ENOMEM;
  300. goto out_free;
  301. }
  302. init_completion(&request->completion);
  303. if (copy_from_user(chsc_area, user_area, PAGE_SIZE)) {
  304. ret = -EFAULT;
  305. goto out_free;
  306. }
  307. chsc_log_command(chsc_area);
  308. spin_lock_irq(&chsc_lock);
  309. ret = chsc_async(chsc_area, request);
  310. spin_unlock_irq(&chsc_lock);
  311. if (ret == -EINPROGRESS) {
  312. wait_for_completion(&request->completion);
  313. ret = chsc_examine_irb(request);
  314. }
  315. /* copy area back to user */
  316. if (!ret)
  317. if (copy_to_user(user_area, chsc_area, PAGE_SIZE))
  318. ret = -EFAULT;
  319. out_free:
  320. sprintf(dbf, "ret:%d", ret);
  321. CHSC_LOG(0, dbf);
  322. kfree(request);
  323. free_page((unsigned long)chsc_area);
  324. return ret;
  325. }
  326. static int chsc_ioctl_info_channel_path(void __user *user_cd)
  327. {
  328. struct chsc_chp_cd *cd;
  329. int ret, ccode;
  330. struct {
  331. struct chsc_header request;
  332. u32 : 2;
  333. u32 m : 1;
  334. u32 : 1;
  335. u32 fmt1 : 4;
  336. u32 cssid : 8;
  337. u32 : 8;
  338. u32 first_chpid : 8;
  339. u32 : 24;
  340. u32 last_chpid : 8;
  341. u32 : 32;
  342. struct chsc_header response;
  343. u8 data[PAGE_SIZE - 20];
  344. } __attribute__ ((packed)) *scpcd_area;
  345. scpcd_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
  346. if (!scpcd_area)
  347. return -ENOMEM;
  348. cd = kzalloc(sizeof(*cd), GFP_KERNEL);
  349. if (!cd) {
  350. ret = -ENOMEM;
  351. goto out_free;
  352. }
  353. if (copy_from_user(cd, user_cd, sizeof(*cd))) {
  354. ret = -EFAULT;
  355. goto out_free;
  356. }
  357. scpcd_area->request.length = 0x0010;
  358. scpcd_area->request.code = 0x0028;
  359. scpcd_area->m = cd->m;
  360. scpcd_area->fmt1 = cd->fmt;
  361. scpcd_area->cssid = cd->chpid.cssid;
  362. scpcd_area->first_chpid = cd->chpid.id;
  363. scpcd_area->last_chpid = cd->chpid.id;
  364. ccode = chsc(scpcd_area);
  365. if (ccode != 0) {
  366. ret = -EIO;
  367. goto out_free;
  368. }
  369. if (scpcd_area->response.code != 0x0001) {
  370. ret = -EIO;
  371. CHSC_MSG(0, "scpcd: response code=%x\n",
  372. scpcd_area->response.code);
  373. goto out_free;
  374. }
  375. memcpy(&cd->cpcb, &scpcd_area->response, scpcd_area->response.length);
  376. if (copy_to_user(user_cd, cd, sizeof(*cd)))
  377. ret = -EFAULT;
  378. else
  379. ret = 0;
  380. out_free:
  381. kfree(cd);
  382. free_page((unsigned long)scpcd_area);
  383. return ret;
  384. }
  385. static int chsc_ioctl_info_cu(void __user *user_cd)
  386. {
  387. struct chsc_cu_cd *cd;
  388. int ret, ccode;
  389. struct {
  390. struct chsc_header request;
  391. u32 : 2;
  392. u32 m : 1;
  393. u32 : 1;
  394. u32 fmt1 : 4;
  395. u32 cssid : 8;
  396. u32 : 8;
  397. u32 first_cun : 8;
  398. u32 : 24;
  399. u32 last_cun : 8;
  400. u32 : 32;
  401. struct chsc_header response;
  402. u8 data[PAGE_SIZE - 20];
  403. } __attribute__ ((packed)) *scucd_area;
  404. scucd_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
  405. if (!scucd_area)
  406. return -ENOMEM;
  407. cd = kzalloc(sizeof(*cd), GFP_KERNEL);
  408. if (!cd) {
  409. ret = -ENOMEM;
  410. goto out_free;
  411. }
  412. if (copy_from_user(cd, user_cd, sizeof(*cd))) {
  413. ret = -EFAULT;
  414. goto out_free;
  415. }
  416. scucd_area->request.length = 0x0010;
  417. scucd_area->request.code = 0x0028;
  418. scucd_area->m = cd->m;
  419. scucd_area->fmt1 = cd->fmt;
  420. scucd_area->cssid = cd->cssid;
  421. scucd_area->first_cun = cd->cun;
  422. scucd_area->last_cun = cd->cun;
  423. ccode = chsc(scucd_area);
  424. if (ccode != 0) {
  425. ret = -EIO;
  426. goto out_free;
  427. }
  428. if (scucd_area->response.code != 0x0001) {
  429. ret = -EIO;
  430. CHSC_MSG(0, "scucd: response code=%x\n",
  431. scucd_area->response.code);
  432. goto out_free;
  433. }
  434. memcpy(&cd->cucb, &scucd_area->response, scucd_area->response.length);
  435. if (copy_to_user(user_cd, cd, sizeof(*cd)))
  436. ret = -EFAULT;
  437. else
  438. ret = 0;
  439. out_free:
  440. kfree(cd);
  441. free_page((unsigned long)scucd_area);
  442. return ret;
  443. }
  444. static int chsc_ioctl_info_sch_cu(void __user *user_cud)
  445. {
  446. struct chsc_sch_cud *cud;
  447. int ret, ccode;
  448. struct {
  449. struct chsc_header request;
  450. u32 : 2;
  451. u32 m : 1;
  452. u32 : 5;
  453. u32 fmt1 : 4;
  454. u32 : 2;
  455. u32 ssid : 2;
  456. u32 first_sch : 16;
  457. u32 : 8;
  458. u32 cssid : 8;
  459. u32 last_sch : 16;
  460. u32 : 32;
  461. struct chsc_header response;
  462. u8 data[PAGE_SIZE - 20];
  463. } __attribute__ ((packed)) *sscud_area;
  464. sscud_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
  465. if (!sscud_area)
  466. return -ENOMEM;
  467. cud = kzalloc(sizeof(*cud), GFP_KERNEL);
  468. if (!cud) {
  469. ret = -ENOMEM;
  470. goto out_free;
  471. }
  472. if (copy_from_user(cud, user_cud, sizeof(*cud))) {
  473. ret = -EFAULT;
  474. goto out_free;
  475. }
  476. sscud_area->request.length = 0x0010;
  477. sscud_area->request.code = 0x0006;
  478. sscud_area->m = cud->schid.m;
  479. sscud_area->fmt1 = cud->fmt;
  480. sscud_area->ssid = cud->schid.ssid;
  481. sscud_area->first_sch = cud->schid.sch_no;
  482. sscud_area->cssid = cud->schid.cssid;
  483. sscud_area->last_sch = cud->schid.sch_no;
  484. ccode = chsc(sscud_area);
  485. if (ccode != 0) {
  486. ret = -EIO;
  487. goto out_free;
  488. }
  489. if (sscud_area->response.code != 0x0001) {
  490. ret = -EIO;
  491. CHSC_MSG(0, "sscud: response code=%x\n",
  492. sscud_area->response.code);
  493. goto out_free;
  494. }
  495. memcpy(&cud->scub, &sscud_area->response, sscud_area->response.length);
  496. if (copy_to_user(user_cud, cud, sizeof(*cud)))
  497. ret = -EFAULT;
  498. else
  499. ret = 0;
  500. out_free:
  501. kfree(cud);
  502. free_page((unsigned long)sscud_area);
  503. return ret;
  504. }
  505. static int chsc_ioctl_conf_info(void __user *user_ci)
  506. {
  507. struct chsc_conf_info *ci;
  508. int ret, ccode;
  509. struct {
  510. struct chsc_header request;
  511. u32 : 2;
  512. u32 m : 1;
  513. u32 : 1;
  514. u32 fmt1 : 4;
  515. u32 cssid : 8;
  516. u32 : 6;
  517. u32 ssid : 2;
  518. u32 : 8;
  519. u64 : 64;
  520. struct chsc_header response;
  521. u8 data[PAGE_SIZE - 20];
  522. } __attribute__ ((packed)) *sci_area;
  523. sci_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
  524. if (!sci_area)
  525. return -ENOMEM;
  526. ci = kzalloc(sizeof(*ci), GFP_KERNEL);
  527. if (!ci) {
  528. ret = -ENOMEM;
  529. goto out_free;
  530. }
  531. if (copy_from_user(ci, user_ci, sizeof(*ci))) {
  532. ret = -EFAULT;
  533. goto out_free;
  534. }
  535. sci_area->request.length = 0x0010;
  536. sci_area->request.code = 0x0012;
  537. sci_area->m = ci->id.m;
  538. sci_area->fmt1 = ci->fmt;
  539. sci_area->cssid = ci->id.cssid;
  540. sci_area->ssid = ci->id.ssid;
  541. ccode = chsc(sci_area);
  542. if (ccode != 0) {
  543. ret = -EIO;
  544. goto out_free;
  545. }
  546. if (sci_area->response.code != 0x0001) {
  547. ret = -EIO;
  548. CHSC_MSG(0, "sci: response code=%x\n",
  549. sci_area->response.code);
  550. goto out_free;
  551. }
  552. memcpy(&ci->scid, &sci_area->response, sci_area->response.length);
  553. if (copy_to_user(user_ci, ci, sizeof(*ci)))
  554. ret = -EFAULT;
  555. else
  556. ret = 0;
  557. out_free:
  558. kfree(ci);
  559. free_page((unsigned long)sci_area);
  560. return ret;
  561. }
  562. static int chsc_ioctl_conf_comp_list(void __user *user_ccl)
  563. {
  564. struct chsc_comp_list *ccl;
  565. int ret, ccode;
  566. struct {
  567. struct chsc_header request;
  568. u32 ctype : 8;
  569. u32 : 4;
  570. u32 fmt : 4;
  571. u32 : 16;
  572. u64 : 64;
  573. u32 list_parm[2];
  574. u64 : 64;
  575. struct chsc_header response;
  576. u8 data[PAGE_SIZE - 36];
  577. } __attribute__ ((packed)) *sccl_area;
  578. struct {
  579. u32 m : 1;
  580. u32 : 31;
  581. u32 cssid : 8;
  582. u32 : 16;
  583. u32 chpid : 8;
  584. } __attribute__ ((packed)) *chpid_parm;
  585. struct {
  586. u32 f_cssid : 8;
  587. u32 l_cssid : 8;
  588. u32 : 16;
  589. u32 res;
  590. } __attribute__ ((packed)) *cssids_parm;
  591. sccl_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
  592. if (!sccl_area)
  593. return -ENOMEM;
  594. ccl = kzalloc(sizeof(*ccl), GFP_KERNEL);
  595. if (!ccl) {
  596. ret = -ENOMEM;
  597. goto out_free;
  598. }
  599. if (copy_from_user(ccl, user_ccl, sizeof(*ccl))) {
  600. ret = -EFAULT;
  601. goto out_free;
  602. }
  603. sccl_area->request.length = 0x0020;
  604. sccl_area->request.code = 0x0030;
  605. sccl_area->fmt = ccl->req.fmt;
  606. sccl_area->ctype = ccl->req.ctype;
  607. switch (sccl_area->ctype) {
  608. case CCL_CU_ON_CHP:
  609. case CCL_IOP_CHP:
  610. chpid_parm = (void *)&sccl_area->list_parm;
  611. chpid_parm->m = ccl->req.chpid.m;
  612. chpid_parm->cssid = ccl->req.chpid.chp.cssid;
  613. chpid_parm->chpid = ccl->req.chpid.chp.id;
  614. break;
  615. case CCL_CSS_IMG:
  616. case CCL_CSS_IMG_CONF_CHAR:
  617. cssids_parm = (void *)&sccl_area->list_parm;
  618. cssids_parm->f_cssid = ccl->req.cssids.f_cssid;
  619. cssids_parm->l_cssid = ccl->req.cssids.l_cssid;
  620. break;
  621. }
  622. ccode = chsc(sccl_area);
  623. if (ccode != 0) {
  624. ret = -EIO;
  625. goto out_free;
  626. }
  627. if (sccl_area->response.code != 0x0001) {
  628. ret = -EIO;
  629. CHSC_MSG(0, "sccl: response code=%x\n",
  630. sccl_area->response.code);
  631. goto out_free;
  632. }
  633. memcpy(&ccl->sccl, &sccl_area->response, sccl_area->response.length);
  634. if (copy_to_user(user_ccl, ccl, sizeof(*ccl)))
  635. ret = -EFAULT;
  636. else
  637. ret = 0;
  638. out_free:
  639. kfree(ccl);
  640. free_page((unsigned long)sccl_area);
  641. return ret;
  642. }
  643. static int chsc_ioctl_chpd(void __user *user_chpd)
  644. {
  645. struct chsc_scpd *scpd_area;
  646. struct chsc_cpd_info *chpd;
  647. int ret;
  648. chpd = kzalloc(sizeof(*chpd), GFP_KERNEL);
  649. scpd_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
  650. if (!scpd_area || !chpd) {
  651. ret = -ENOMEM;
  652. goto out_free;
  653. }
  654. if (copy_from_user(chpd, user_chpd, sizeof(*chpd))) {
  655. ret = -EFAULT;
  656. goto out_free;
  657. }
  658. ret = chsc_determine_channel_path_desc(chpd->chpid, chpd->fmt,
  659. chpd->rfmt, chpd->c, chpd->m,
  660. scpd_area);
  661. if (ret)
  662. goto out_free;
  663. memcpy(&chpd->chpdb, &scpd_area->response, scpd_area->response.length);
  664. if (copy_to_user(user_chpd, chpd, sizeof(*chpd)))
  665. ret = -EFAULT;
  666. out_free:
  667. kfree(chpd);
  668. free_page((unsigned long)scpd_area);
  669. return ret;
  670. }
  671. static int chsc_ioctl_dcal(void __user *user_dcal)
  672. {
  673. struct chsc_dcal *dcal;
  674. int ret, ccode;
  675. struct {
  676. struct chsc_header request;
  677. u32 atype : 8;
  678. u32 : 4;
  679. u32 fmt : 4;
  680. u32 : 16;
  681. u32 res0[2];
  682. u32 list_parm[2];
  683. u32 res1[2];
  684. struct chsc_header response;
  685. u8 data[PAGE_SIZE - 36];
  686. } __attribute__ ((packed)) *sdcal_area;
  687. sdcal_area = (void *)get_zeroed_page(GFP_KERNEL | GFP_DMA);
  688. if (!sdcal_area)
  689. return -ENOMEM;
  690. dcal = kzalloc(sizeof(*dcal), GFP_KERNEL);
  691. if (!dcal) {
  692. ret = -ENOMEM;
  693. goto out_free;
  694. }
  695. if (copy_from_user(dcal, user_dcal, sizeof(*dcal))) {
  696. ret = -EFAULT;
  697. goto out_free;
  698. }
  699. sdcal_area->request.length = 0x0020;
  700. sdcal_area->request.code = 0x0034;
  701. sdcal_area->atype = dcal->req.atype;
  702. sdcal_area->fmt = dcal->req.fmt;
  703. memcpy(&sdcal_area->list_parm, &dcal->req.list_parm,
  704. sizeof(sdcal_area->list_parm));
  705. ccode = chsc(sdcal_area);
  706. if (ccode != 0) {
  707. ret = -EIO;
  708. goto out_free;
  709. }
  710. if (sdcal_area->response.code != 0x0001) {
  711. ret = -EIO;
  712. CHSC_MSG(0, "sdcal: response code=%x\n",
  713. sdcal_area->response.code);
  714. goto out_free;
  715. }
  716. memcpy(&dcal->sdcal, &sdcal_area->response,
  717. sdcal_area->response.length);
  718. if (copy_to_user(user_dcal, dcal, sizeof(*dcal)))
  719. ret = -EFAULT;
  720. else
  721. ret = 0;
  722. out_free:
  723. kfree(dcal);
  724. free_page((unsigned long)sdcal_area);
  725. return ret;
  726. }
  727. static long chsc_ioctl(struct file *filp, unsigned int cmd,
  728. unsigned long arg)
  729. {
  730. void __user *argp;
  731. CHSC_MSG(2, "chsc_ioctl called, cmd=%x\n", cmd);
  732. if (is_compat_task())
  733. argp = compat_ptr(arg);
  734. else
  735. argp = (void __user *)arg;
  736. switch (cmd) {
  737. case CHSC_START:
  738. return chsc_ioctl_start(argp);
  739. case CHSC_INFO_CHANNEL_PATH:
  740. return chsc_ioctl_info_channel_path(argp);
  741. case CHSC_INFO_CU:
  742. return chsc_ioctl_info_cu(argp);
  743. case CHSC_INFO_SCH_CU:
  744. return chsc_ioctl_info_sch_cu(argp);
  745. case CHSC_INFO_CI:
  746. return chsc_ioctl_conf_info(argp);
  747. case CHSC_INFO_CCL:
  748. return chsc_ioctl_conf_comp_list(argp);
  749. case CHSC_INFO_CPD:
  750. return chsc_ioctl_chpd(argp);
  751. case CHSC_INFO_DCAL:
  752. return chsc_ioctl_dcal(argp);
  753. default: /* unknown ioctl number */
  754. return -ENOIOCTLCMD;
  755. }
  756. }
  757. static const struct file_operations chsc_fops = {
  758. .owner = THIS_MODULE,
  759. .open = nonseekable_open,
  760. .unlocked_ioctl = chsc_ioctl,
  761. .compat_ioctl = chsc_ioctl,
  762. .llseek = no_llseek,
  763. };
  764. static struct miscdevice chsc_misc_device = {
  765. .minor = MISC_DYNAMIC_MINOR,
  766. .name = "chsc",
  767. .fops = &chsc_fops,
  768. };
  769. static int __init chsc_misc_init(void)
  770. {
  771. return misc_register(&chsc_misc_device);
  772. }
  773. static void chsc_misc_cleanup(void)
  774. {
  775. misc_deregister(&chsc_misc_device);
  776. }
  777. static int __init chsc_sch_init(void)
  778. {
  779. int ret;
  780. ret = chsc_init_dbfs();
  781. if (ret)
  782. return ret;
  783. isc_register(CHSC_SCH_ISC);
  784. ret = chsc_init_sch_driver();
  785. if (ret)
  786. goto out_dbf;
  787. ret = chsc_misc_init();
  788. if (ret)
  789. goto out_driver;
  790. return ret;
  791. out_driver:
  792. chsc_cleanup_sch_driver();
  793. out_dbf:
  794. isc_unregister(CHSC_SCH_ISC);
  795. chsc_remove_dbfs();
  796. return ret;
  797. }
  798. static void __exit chsc_sch_exit(void)
  799. {
  800. chsc_misc_cleanup();
  801. chsc_cleanup_sch_driver();
  802. isc_unregister(CHSC_SCH_ISC);
  803. chsc_remove_dbfs();
  804. }
  805. module_init(chsc_sch_init);
  806. module_exit(chsc_sch_exit);