vmlogrdr.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898
  1. /*
  2. * drivers/s390/char/vmlogrdr.c
  3. * character device driver for reading z/VM system service records
  4. *
  5. *
  6. * Copyright IBM Corp. 2004, 2009
  7. * character device driver for reading z/VM system service records,
  8. * Version 1.0
  9. * Author(s): Xenia Tkatschow <xenia@us.ibm.com>
  10. * Stefan Weinhuber <wein@de.ibm.com>
  11. *
  12. */
  13. #define KMSG_COMPONENT "vmlogrdr"
  14. #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
  15. #include <linux/module.h>
  16. #include <linux/init.h>
  17. #include <linux/errno.h>
  18. #include <linux/types.h>
  19. #include <linux/interrupt.h>
  20. #include <linux/spinlock.h>
  21. #include <asm/atomic.h>
  22. #include <asm/uaccess.h>
  23. #include <asm/cpcmd.h>
  24. #include <asm/debug.h>
  25. #include <asm/ebcdic.h>
  26. #include <net/iucv/iucv.h>
  27. #include <linux/kmod.h>
  28. #include <linux/cdev.h>
  29. #include <linux/device.h>
  30. #include <linux/smp_lock.h>
  31. #include <linux/string.h>
  32. MODULE_AUTHOR
  33. ("(C) 2004 IBM Corporation by Xenia Tkatschow (xenia@us.ibm.com)\n"
  34. " Stefan Weinhuber (wein@de.ibm.com)");
  35. MODULE_DESCRIPTION ("Character device driver for reading z/VM "
  36. "system service records.");
  37. MODULE_LICENSE("GPL");
  38. /*
  39. * The size of the buffer for iucv data transfer is one page,
  40. * but in addition to the data we read from iucv we also
  41. * place an integer and some characters into that buffer,
  42. * so the maximum size for record data is a little less then
  43. * one page.
  44. */
  45. #define NET_BUFFER_SIZE (PAGE_SIZE - sizeof(int) - sizeof(FENCE))
  46. /*
  47. * The elements that are concurrently accessed by bottom halves are
  48. * connection_established, iucv_path_severed, local_interrupt_buffer
  49. * and receive_ready. The first three can be protected by
  50. * priv_lock. receive_ready is atomic, so it can be incremented and
  51. * decremented without holding a lock.
  52. * The variable dev_in_use needs to be protected by the lock, since
  53. * it's a flag used by open to make sure that the device is opened only
  54. * by one user at the same time.
  55. */
  56. struct vmlogrdr_priv_t {
  57. char system_service[8];
  58. char internal_name[8];
  59. char recording_name[8];
  60. struct iucv_path *path;
  61. int connection_established;
  62. int iucv_path_severed;
  63. struct iucv_message local_interrupt_buffer;
  64. atomic_t receive_ready;
  65. int minor_num;
  66. char * buffer;
  67. char * current_position;
  68. int remaining;
  69. ulong residual_length;
  70. int buffer_free;
  71. int dev_in_use; /* 1: already opened, 0: not opened*/
  72. spinlock_t priv_lock;
  73. struct device *device;
  74. struct device *class_device;
  75. int autorecording;
  76. int autopurge;
  77. };
  78. /*
  79. * File operation structure for vmlogrdr devices
  80. */
  81. static int vmlogrdr_open(struct inode *, struct file *);
  82. static int vmlogrdr_release(struct inode *, struct file *);
  83. static ssize_t vmlogrdr_read (struct file *filp, char __user *data,
  84. size_t count, loff_t * ppos);
  85. static const struct file_operations vmlogrdr_fops = {
  86. .owner = THIS_MODULE,
  87. .open = vmlogrdr_open,
  88. .release = vmlogrdr_release,
  89. .read = vmlogrdr_read,
  90. };
  91. static void vmlogrdr_iucv_path_complete(struct iucv_path *, u8 ipuser[16]);
  92. static void vmlogrdr_iucv_path_severed(struct iucv_path *, u8 ipuser[16]);
  93. static void vmlogrdr_iucv_message_pending(struct iucv_path *,
  94. struct iucv_message *);
  95. static struct iucv_handler vmlogrdr_iucv_handler = {
  96. .path_complete = vmlogrdr_iucv_path_complete,
  97. .path_severed = vmlogrdr_iucv_path_severed,
  98. .message_pending = vmlogrdr_iucv_message_pending,
  99. };
  100. static DECLARE_WAIT_QUEUE_HEAD(conn_wait_queue);
  101. static DECLARE_WAIT_QUEUE_HEAD(read_wait_queue);
  102. /*
  103. * pointer to system service private structure
  104. * minor number 0 --> logrec
  105. * minor number 1 --> account
  106. * minor number 2 --> symptom
  107. */
  108. static struct vmlogrdr_priv_t sys_ser[] = {
  109. { .system_service = "*LOGREC ",
  110. .internal_name = "logrec",
  111. .recording_name = "EREP",
  112. .minor_num = 0,
  113. .buffer_free = 1,
  114. .priv_lock = __SPIN_LOCK_UNLOCKED(sys_ser[0].priv_lock),
  115. .autorecording = 1,
  116. .autopurge = 1,
  117. },
  118. { .system_service = "*ACCOUNT",
  119. .internal_name = "account",
  120. .recording_name = "ACCOUNT",
  121. .minor_num = 1,
  122. .buffer_free = 1,
  123. .priv_lock = __SPIN_LOCK_UNLOCKED(sys_ser[1].priv_lock),
  124. .autorecording = 1,
  125. .autopurge = 1,
  126. },
  127. { .system_service = "*SYMPTOM",
  128. .internal_name = "symptom",
  129. .recording_name = "SYMPTOM",
  130. .minor_num = 2,
  131. .buffer_free = 1,
  132. .priv_lock = __SPIN_LOCK_UNLOCKED(sys_ser[2].priv_lock),
  133. .autorecording = 1,
  134. .autopurge = 1,
  135. }
  136. };
  137. #define MAXMINOR (sizeof(sys_ser)/sizeof(struct vmlogrdr_priv_t))
  138. static char FENCE[] = {"EOR"};
  139. static int vmlogrdr_major = 0;
  140. static struct cdev *vmlogrdr_cdev = NULL;
  141. static int recording_class_AB;
  142. static void vmlogrdr_iucv_path_complete(struct iucv_path *path, u8 ipuser[16])
  143. {
  144. struct vmlogrdr_priv_t * logptr = path->private;
  145. spin_lock(&logptr->priv_lock);
  146. logptr->connection_established = 1;
  147. spin_unlock(&logptr->priv_lock);
  148. wake_up(&conn_wait_queue);
  149. }
  150. static void vmlogrdr_iucv_path_severed(struct iucv_path *path, u8 ipuser[16])
  151. {
  152. struct vmlogrdr_priv_t * logptr = path->private;
  153. u8 reason = (u8) ipuser[8];
  154. pr_err("vmlogrdr: connection severed with reason %i\n", reason);
  155. iucv_path_sever(path, NULL);
  156. kfree(path);
  157. logptr->path = NULL;
  158. spin_lock(&logptr->priv_lock);
  159. logptr->connection_established = 0;
  160. logptr->iucv_path_severed = 1;
  161. spin_unlock(&logptr->priv_lock);
  162. wake_up(&conn_wait_queue);
  163. /* just in case we're sleeping waiting for a record */
  164. wake_up_interruptible(&read_wait_queue);
  165. }
  166. static void vmlogrdr_iucv_message_pending(struct iucv_path *path,
  167. struct iucv_message *msg)
  168. {
  169. struct vmlogrdr_priv_t * logptr = path->private;
  170. /*
  171. * This function is the bottom half so it should be quick.
  172. * Copy the external interrupt data into our local eib and increment
  173. * the usage count
  174. */
  175. spin_lock(&logptr->priv_lock);
  176. memcpy(&logptr->local_interrupt_buffer, msg, sizeof(*msg));
  177. atomic_inc(&logptr->receive_ready);
  178. spin_unlock(&logptr->priv_lock);
  179. wake_up_interruptible(&read_wait_queue);
  180. }
  181. static int vmlogrdr_get_recording_class_AB(void)
  182. {
  183. char cp_command[]="QUERY COMMAND RECORDING ";
  184. char cp_response[80];
  185. char *tail;
  186. int len,i;
  187. cpcmd(cp_command, cp_response, sizeof(cp_response), NULL);
  188. len = strnlen(cp_response,sizeof(cp_response));
  189. // now the parsing
  190. tail=strnchr(cp_response,len,'=');
  191. if (!tail)
  192. return 0;
  193. tail++;
  194. if (!strncmp("ANY",tail,3))
  195. return 1;
  196. if (!strncmp("NONE",tail,4))
  197. return 0;
  198. /*
  199. * expect comma separated list of classes here, if one of them
  200. * is A or B return 1 otherwise 0
  201. */
  202. for (i=tail-cp_response; i<len; i++)
  203. if ( cp_response[i]=='A' || cp_response[i]=='B' )
  204. return 1;
  205. return 0;
  206. }
  207. static int vmlogrdr_recording(struct vmlogrdr_priv_t * logptr,
  208. int action, int purge)
  209. {
  210. char cp_command[80];
  211. char cp_response[160];
  212. char *onoff, *qid_string;
  213. memset(cp_command, 0x00, sizeof(cp_command));
  214. memset(cp_response, 0x00, sizeof(cp_response));
  215. onoff = ((action == 1) ? "ON" : "OFF");
  216. qid_string = ((recording_class_AB == 1) ? " QID * " : "");
  217. /*
  218. * The recording commands needs to be called with option QID
  219. * for guests that have previlege classes A or B.
  220. * Purging has to be done as separate step, because recording
  221. * can't be switched on as long as records are on the queue.
  222. * Doing both at the same time doesn't work.
  223. */
  224. if (purge) {
  225. snprintf(cp_command, sizeof(cp_command),
  226. "RECORDING %s PURGE %s",
  227. logptr->recording_name,
  228. qid_string);
  229. cpcmd(cp_command, cp_response, sizeof(cp_response), NULL);
  230. }
  231. memset(cp_command, 0x00, sizeof(cp_command));
  232. memset(cp_response, 0x00, sizeof(cp_response));
  233. snprintf(cp_command, sizeof(cp_command), "RECORDING %s %s %s",
  234. logptr->recording_name,
  235. onoff,
  236. qid_string);
  237. cpcmd(cp_command, cp_response, sizeof(cp_response), NULL);
  238. /* The recording command will usually answer with 'Command complete'
  239. * on success, but when the specific service was never connected
  240. * before then there might be an additional informational message
  241. * 'HCPCRC8072I Recording entry not found' before the
  242. * 'Command complete'. So I use strstr rather then the strncmp.
  243. */
  244. if (strstr(cp_response,"Command complete"))
  245. return 0;
  246. else
  247. return -EIO;
  248. }
  249. static int vmlogrdr_open (struct inode *inode, struct file *filp)
  250. {
  251. int dev_num = 0;
  252. struct vmlogrdr_priv_t * logptr = NULL;
  253. int connect_rc = 0;
  254. int ret;
  255. dev_num = iminor(inode);
  256. if (dev_num > MAXMINOR)
  257. return -ENODEV;
  258. logptr = &sys_ser[dev_num];
  259. /*
  260. * only allow for blocking reads to be open
  261. */
  262. if (filp->f_flags & O_NONBLOCK)
  263. return -ENOSYS;
  264. /* Besure this device hasn't already been opened */
  265. spin_lock_bh(&logptr->priv_lock);
  266. if (logptr->dev_in_use) {
  267. spin_unlock_bh(&logptr->priv_lock);
  268. return -EBUSY;
  269. }
  270. logptr->dev_in_use = 1;
  271. logptr->connection_established = 0;
  272. logptr->iucv_path_severed = 0;
  273. atomic_set(&logptr->receive_ready, 0);
  274. logptr->buffer_free = 1;
  275. spin_unlock_bh(&logptr->priv_lock);
  276. /* set the file options */
  277. filp->private_data = logptr;
  278. filp->f_op = &vmlogrdr_fops;
  279. /* start recording for this service*/
  280. if (logptr->autorecording) {
  281. ret = vmlogrdr_recording(logptr,1,logptr->autopurge);
  282. if (ret)
  283. pr_warning("vmlogrdr: failed to start "
  284. "recording automatically\n");
  285. }
  286. /* create connection to the system service */
  287. logptr->path = iucv_path_alloc(10, 0, GFP_KERNEL);
  288. if (!logptr->path)
  289. goto out_dev;
  290. connect_rc = iucv_path_connect(logptr->path, &vmlogrdr_iucv_handler,
  291. logptr->system_service, NULL, NULL,
  292. logptr);
  293. if (connect_rc) {
  294. pr_err("vmlogrdr: iucv connection to %s "
  295. "failed with rc %i \n",
  296. logptr->system_service, connect_rc);
  297. goto out_path;
  298. }
  299. /* We've issued the connect and now we must wait for a
  300. * ConnectionComplete or ConnectinSevered Interrupt
  301. * before we can continue to process.
  302. */
  303. wait_event(conn_wait_queue, (logptr->connection_established)
  304. || (logptr->iucv_path_severed));
  305. if (logptr->iucv_path_severed)
  306. goto out_record;
  307. nonseekable_open(inode, filp);
  308. return 0;
  309. out_record:
  310. if (logptr->autorecording)
  311. vmlogrdr_recording(logptr,0,logptr->autopurge);
  312. out_path:
  313. kfree(logptr->path); /* kfree(NULL) is ok. */
  314. logptr->path = NULL;
  315. out_dev:
  316. logptr->dev_in_use = 0;
  317. return -EIO;
  318. }
  319. static int vmlogrdr_release (struct inode *inode, struct file *filp)
  320. {
  321. int ret;
  322. struct vmlogrdr_priv_t * logptr = filp->private_data;
  323. iucv_path_sever(logptr->path, NULL);
  324. kfree(logptr->path);
  325. logptr->path = NULL;
  326. if (logptr->autorecording) {
  327. ret = vmlogrdr_recording(logptr,0,logptr->autopurge);
  328. if (ret)
  329. pr_warning("vmlogrdr: failed to stop "
  330. "recording automatically\n");
  331. }
  332. logptr->dev_in_use = 0;
  333. return 0;
  334. }
  335. static int vmlogrdr_receive_data(struct vmlogrdr_priv_t *priv)
  336. {
  337. int rc, *temp;
  338. /* we need to keep track of two data sizes here:
  339. * The number of bytes we need to receive from iucv and
  340. * the total number of bytes we actually write into the buffer.
  341. */
  342. int user_data_count, iucv_data_count;
  343. char * buffer;
  344. if (atomic_read(&priv->receive_ready)) {
  345. spin_lock_bh(&priv->priv_lock);
  346. if (priv->residual_length){
  347. /* receive second half of a record */
  348. iucv_data_count = priv->residual_length;
  349. user_data_count = 0;
  350. buffer = priv->buffer;
  351. } else {
  352. /* receive a new record:
  353. * We need to return the total length of the record
  354. * + size of FENCE in the first 4 bytes of the buffer.
  355. */
  356. iucv_data_count = priv->local_interrupt_buffer.length;
  357. user_data_count = sizeof(int);
  358. temp = (int*)priv->buffer;
  359. *temp= iucv_data_count + sizeof(FENCE);
  360. buffer = priv->buffer + sizeof(int);
  361. }
  362. /*
  363. * If the record is bigger than our buffer, we receive only
  364. * a part of it. We can get the rest later.
  365. */
  366. if (iucv_data_count > NET_BUFFER_SIZE)
  367. iucv_data_count = NET_BUFFER_SIZE;
  368. rc = iucv_message_receive(priv->path,
  369. &priv->local_interrupt_buffer,
  370. 0, buffer, iucv_data_count,
  371. &priv->residual_length);
  372. spin_unlock_bh(&priv->priv_lock);
  373. /* An rc of 5 indicates that the record was bigger than
  374. * the buffer, which is OK for us. A 9 indicates that the
  375. * record was purged befor we could receive it.
  376. */
  377. if (rc == 5)
  378. rc = 0;
  379. if (rc == 9)
  380. atomic_set(&priv->receive_ready, 0);
  381. } else {
  382. rc = 1;
  383. }
  384. if (!rc) {
  385. priv->buffer_free = 0;
  386. user_data_count += iucv_data_count;
  387. priv->current_position = priv->buffer;
  388. if (priv->residual_length == 0){
  389. /* the whole record has been captured,
  390. * now add the fence */
  391. atomic_dec(&priv->receive_ready);
  392. buffer = priv->buffer + user_data_count;
  393. memcpy(buffer, FENCE, sizeof(FENCE));
  394. user_data_count += sizeof(FENCE);
  395. }
  396. priv->remaining = user_data_count;
  397. }
  398. return rc;
  399. }
  400. static ssize_t vmlogrdr_read(struct file *filp, char __user *data,
  401. size_t count, loff_t * ppos)
  402. {
  403. int rc;
  404. struct vmlogrdr_priv_t * priv = filp->private_data;
  405. while (priv->buffer_free) {
  406. rc = vmlogrdr_receive_data(priv);
  407. if (rc) {
  408. rc = wait_event_interruptible(read_wait_queue,
  409. atomic_read(&priv->receive_ready));
  410. if (rc)
  411. return rc;
  412. }
  413. }
  414. /* copy only up to end of record */
  415. if (count > priv->remaining)
  416. count = priv->remaining;
  417. if (copy_to_user(data, priv->current_position, count))
  418. return -EFAULT;
  419. *ppos += count;
  420. priv->current_position += count;
  421. priv->remaining -= count;
  422. /* if all data has been transferred, set buffer free */
  423. if (priv->remaining == 0)
  424. priv->buffer_free = 1;
  425. return count;
  426. }
  427. static ssize_t vmlogrdr_autopurge_store(struct device * dev,
  428. struct device_attribute *attr,
  429. const char * buf, size_t count)
  430. {
  431. struct vmlogrdr_priv_t *priv = dev_get_drvdata(dev);
  432. ssize_t ret = count;
  433. switch (buf[0]) {
  434. case '0':
  435. priv->autopurge=0;
  436. break;
  437. case '1':
  438. priv->autopurge=1;
  439. break;
  440. default:
  441. ret = -EINVAL;
  442. }
  443. return ret;
  444. }
  445. static ssize_t vmlogrdr_autopurge_show(struct device *dev,
  446. struct device_attribute *attr,
  447. char *buf)
  448. {
  449. struct vmlogrdr_priv_t *priv = dev_get_drvdata(dev);
  450. return sprintf(buf, "%u\n", priv->autopurge);
  451. }
  452. static DEVICE_ATTR(autopurge, 0644, vmlogrdr_autopurge_show,
  453. vmlogrdr_autopurge_store);
  454. static ssize_t vmlogrdr_purge_store(struct device * dev,
  455. struct device_attribute *attr,
  456. const char * buf, size_t count)
  457. {
  458. char cp_command[80];
  459. char cp_response[80];
  460. struct vmlogrdr_priv_t *priv = dev_get_drvdata(dev);
  461. if (buf[0] != '1')
  462. return -EINVAL;
  463. memset(cp_command, 0x00, sizeof(cp_command));
  464. memset(cp_response, 0x00, sizeof(cp_response));
  465. /*
  466. * The recording command needs to be called with option QID
  467. * for guests that have previlege classes A or B.
  468. * Other guests will not recognize the command and we have to
  469. * issue the same command without the QID parameter.
  470. */
  471. if (recording_class_AB)
  472. snprintf(cp_command, sizeof(cp_command),
  473. "RECORDING %s PURGE QID * ",
  474. priv->recording_name);
  475. else
  476. snprintf(cp_command, sizeof(cp_command),
  477. "RECORDING %s PURGE ",
  478. priv->recording_name);
  479. cpcmd(cp_command, cp_response, sizeof(cp_response), NULL);
  480. return count;
  481. }
  482. static DEVICE_ATTR(purge, 0200, NULL, vmlogrdr_purge_store);
  483. static ssize_t vmlogrdr_autorecording_store(struct device *dev,
  484. struct device_attribute *attr,
  485. const char *buf, size_t count)
  486. {
  487. struct vmlogrdr_priv_t *priv = dev_get_drvdata(dev);
  488. ssize_t ret = count;
  489. switch (buf[0]) {
  490. case '0':
  491. priv->autorecording=0;
  492. break;
  493. case '1':
  494. priv->autorecording=1;
  495. break;
  496. default:
  497. ret = -EINVAL;
  498. }
  499. return ret;
  500. }
  501. static ssize_t vmlogrdr_autorecording_show(struct device *dev,
  502. struct device_attribute *attr,
  503. char *buf)
  504. {
  505. struct vmlogrdr_priv_t *priv = dev_get_drvdata(dev);
  506. return sprintf(buf, "%u\n", priv->autorecording);
  507. }
  508. static DEVICE_ATTR(autorecording, 0644, vmlogrdr_autorecording_show,
  509. vmlogrdr_autorecording_store);
  510. static ssize_t vmlogrdr_recording_store(struct device * dev,
  511. struct device_attribute *attr,
  512. const char * buf, size_t count)
  513. {
  514. struct vmlogrdr_priv_t *priv = dev_get_drvdata(dev);
  515. ssize_t ret;
  516. switch (buf[0]) {
  517. case '0':
  518. ret = vmlogrdr_recording(priv,0,0);
  519. break;
  520. case '1':
  521. ret = vmlogrdr_recording(priv,1,0);
  522. break;
  523. default:
  524. ret = -EINVAL;
  525. }
  526. if (ret)
  527. return ret;
  528. else
  529. return count;
  530. }
  531. static DEVICE_ATTR(recording, 0200, NULL, vmlogrdr_recording_store);
  532. static ssize_t vmlogrdr_recording_status_show(struct device_driver *driver,
  533. char *buf)
  534. {
  535. char cp_command[] = "QUERY RECORDING ";
  536. int len;
  537. cpcmd(cp_command, buf, 4096, NULL);
  538. len = strlen(buf);
  539. return len;
  540. }
  541. static DRIVER_ATTR(recording_status, 0444, vmlogrdr_recording_status_show,
  542. NULL);
  543. static struct attribute *vmlogrdr_attrs[] = {
  544. &dev_attr_autopurge.attr,
  545. &dev_attr_purge.attr,
  546. &dev_attr_autorecording.attr,
  547. &dev_attr_recording.attr,
  548. NULL,
  549. };
  550. static int vmlogrdr_pm_prepare(struct device *dev)
  551. {
  552. int rc;
  553. struct vmlogrdr_priv_t *priv = dev_get_drvdata(dev);
  554. rc = 0;
  555. if (priv) {
  556. spin_lock_bh(&priv->priv_lock);
  557. if (priv->dev_in_use)
  558. rc = -EBUSY;
  559. spin_unlock_bh(&priv->priv_lock);
  560. }
  561. if (rc)
  562. pr_err("vmlogrdr: device %s is busy. Refuse to suspend.\n",
  563. dev_name(dev));
  564. return rc;
  565. }
  566. static const struct dev_pm_ops vmlogrdr_pm_ops = {
  567. .prepare = vmlogrdr_pm_prepare,
  568. };
  569. static struct attribute_group vmlogrdr_attr_group = {
  570. .attrs = vmlogrdr_attrs,
  571. };
  572. static struct class *vmlogrdr_class;
  573. static struct device_driver vmlogrdr_driver = {
  574. .name = "vmlogrdr",
  575. .bus = &iucv_bus,
  576. .pm = &vmlogrdr_pm_ops,
  577. };
  578. static int vmlogrdr_register_driver(void)
  579. {
  580. int ret;
  581. /* Register with iucv driver */
  582. ret = iucv_register(&vmlogrdr_iucv_handler, 1);
  583. if (ret)
  584. goto out;
  585. ret = driver_register(&vmlogrdr_driver);
  586. if (ret)
  587. goto out_iucv;
  588. ret = driver_create_file(&vmlogrdr_driver,
  589. &driver_attr_recording_status);
  590. if (ret)
  591. goto out_driver;
  592. vmlogrdr_class = class_create(THIS_MODULE, "vmlogrdr");
  593. if (IS_ERR(vmlogrdr_class)) {
  594. ret = PTR_ERR(vmlogrdr_class);
  595. vmlogrdr_class = NULL;
  596. goto out_attr;
  597. }
  598. return 0;
  599. out_attr:
  600. driver_remove_file(&vmlogrdr_driver, &driver_attr_recording_status);
  601. out_driver:
  602. driver_unregister(&vmlogrdr_driver);
  603. out_iucv:
  604. iucv_unregister(&vmlogrdr_iucv_handler, 1);
  605. out:
  606. return ret;
  607. }
  608. static void vmlogrdr_unregister_driver(void)
  609. {
  610. class_destroy(vmlogrdr_class);
  611. vmlogrdr_class = NULL;
  612. driver_remove_file(&vmlogrdr_driver, &driver_attr_recording_status);
  613. driver_unregister(&vmlogrdr_driver);
  614. iucv_unregister(&vmlogrdr_iucv_handler, 1);
  615. }
  616. static int vmlogrdr_register_device(struct vmlogrdr_priv_t *priv)
  617. {
  618. struct device *dev;
  619. int ret;
  620. dev = kzalloc(sizeof(struct device), GFP_KERNEL);
  621. if (dev) {
  622. dev_set_name(dev, priv->internal_name);
  623. dev->bus = &iucv_bus;
  624. dev->parent = iucv_root;
  625. dev->driver = &vmlogrdr_driver;
  626. dev_set_drvdata(dev, priv);
  627. /*
  628. * The release function could be called after the
  629. * module has been unloaded. It's _only_ task is to
  630. * free the struct. Therefore, we specify kfree()
  631. * directly here. (Probably a little bit obfuscating
  632. * but legitime ...).
  633. */
  634. dev->release = (void (*)(struct device *))kfree;
  635. } else
  636. return -ENOMEM;
  637. ret = device_register(dev);
  638. if (ret) {
  639. put_device(dev);
  640. return ret;
  641. }
  642. ret = sysfs_create_group(&dev->kobj, &vmlogrdr_attr_group);
  643. if (ret) {
  644. device_unregister(dev);
  645. return ret;
  646. }
  647. priv->class_device = device_create(vmlogrdr_class, dev,
  648. MKDEV(vmlogrdr_major,
  649. priv->minor_num),
  650. priv, "%s", dev_name(dev));
  651. if (IS_ERR(priv->class_device)) {
  652. ret = PTR_ERR(priv->class_device);
  653. priv->class_device=NULL;
  654. sysfs_remove_group(&dev->kobj, &vmlogrdr_attr_group);
  655. device_unregister(dev);
  656. return ret;
  657. }
  658. priv->device = dev;
  659. return 0;
  660. }
  661. static int vmlogrdr_unregister_device(struct vmlogrdr_priv_t *priv)
  662. {
  663. device_destroy(vmlogrdr_class, MKDEV(vmlogrdr_major, priv->minor_num));
  664. if (priv->device != NULL) {
  665. sysfs_remove_group(&priv->device->kobj, &vmlogrdr_attr_group);
  666. device_unregister(priv->device);
  667. priv->device=NULL;
  668. }
  669. return 0;
  670. }
  671. static int vmlogrdr_register_cdev(dev_t dev)
  672. {
  673. int rc = 0;
  674. vmlogrdr_cdev = cdev_alloc();
  675. if (!vmlogrdr_cdev) {
  676. return -ENOMEM;
  677. }
  678. vmlogrdr_cdev->owner = THIS_MODULE;
  679. vmlogrdr_cdev->ops = &vmlogrdr_fops;
  680. vmlogrdr_cdev->dev = dev;
  681. rc = cdev_add(vmlogrdr_cdev, vmlogrdr_cdev->dev, MAXMINOR);
  682. if (!rc)
  683. return 0;
  684. // cleanup: cdev is not fully registered, no cdev_del here!
  685. kobject_put(&vmlogrdr_cdev->kobj);
  686. vmlogrdr_cdev=NULL;
  687. return rc;
  688. }
  689. static void vmlogrdr_cleanup(void)
  690. {
  691. int i;
  692. if (vmlogrdr_cdev) {
  693. cdev_del(vmlogrdr_cdev);
  694. vmlogrdr_cdev=NULL;
  695. }
  696. for (i=0; i < MAXMINOR; ++i ) {
  697. vmlogrdr_unregister_device(&sys_ser[i]);
  698. free_page((unsigned long)sys_ser[i].buffer);
  699. }
  700. vmlogrdr_unregister_driver();
  701. if (vmlogrdr_major) {
  702. unregister_chrdev_region(MKDEV(vmlogrdr_major, 0), MAXMINOR);
  703. vmlogrdr_major=0;
  704. }
  705. }
  706. static int __init vmlogrdr_init(void)
  707. {
  708. int rc;
  709. int i;
  710. dev_t dev;
  711. if (! MACHINE_IS_VM) {
  712. pr_err("not running under VM, driver not loaded.\n");
  713. return -ENODEV;
  714. }
  715. recording_class_AB = vmlogrdr_get_recording_class_AB();
  716. rc = alloc_chrdev_region(&dev, 0, MAXMINOR, "vmlogrdr");
  717. if (rc)
  718. return rc;
  719. vmlogrdr_major = MAJOR(dev);
  720. rc=vmlogrdr_register_driver();
  721. if (rc)
  722. goto cleanup;
  723. for (i=0; i < MAXMINOR; ++i ) {
  724. sys_ser[i].buffer = (char *) get_zeroed_page(GFP_KERNEL);
  725. if (!sys_ser[i].buffer) {
  726. rc = -ENOMEM;
  727. break;
  728. }
  729. sys_ser[i].current_position = sys_ser[i].buffer;
  730. rc=vmlogrdr_register_device(&sys_ser[i]);
  731. if (rc)
  732. break;
  733. }
  734. if (rc)
  735. goto cleanup;
  736. rc = vmlogrdr_register_cdev(dev);
  737. if (rc)
  738. goto cleanup;
  739. return 0;
  740. cleanup:
  741. vmlogrdr_cleanup();
  742. return rc;
  743. }
  744. static void __exit vmlogrdr_exit(void)
  745. {
  746. vmlogrdr_cleanup();
  747. return;
  748. }
  749. module_init(vmlogrdr_init);
  750. module_exit(vmlogrdr_exit);