devinfosys.c 1.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364
  1. #include <linux/module.h>
  2. #include <linux/init.h>
  3. #include <linux/types.h>
  4. #include <linux/kernel.h>
  5. #include <linux/proc_fs.h>
  6. #include <linux/cdev.h>
  7. #include <linux/mm.h>
  8. #include <asm/io.h>
  9. #include <asm/uaccess.h>
  10. #include <linux/ioctl.h>
  11. #include <linux/device.h>
  12. #include <linux/platform_device.h>
  13. #include "devinfo.h"
  14. #include "mt_devinfo.h"
  15. /**************************************************************************
  16. * DEV DRIVER SYSFS
  17. **************************************************************************/
  18. static struct platform_driver dev_info = {
  19. .driver = {
  20. .name = "dev_info",
  21. .bus = &platform_bus_type,
  22. .owner = THIS_MODULE,
  23. }
  24. };
  25. static ssize_t devinfo_show(struct device_driver *driver, char *buf)
  26. {
  27. unsigned int i;
  28. unsigned int *output = (unsigned int *)buf;
  29. output[0] = devinfo_get_size();
  30. for (i = 0; i < output[0]; i++)
  31. output[i + 1] = get_devinfo_with_index(i);
  32. return (output[0] + 1) * sizeof(unsigned int);
  33. }
  34. DRIVER_ATTR(dev_info, 0444, devinfo_show, NULL);
  35. static int __init devinfo_init(void)
  36. {
  37. int ret = 0;
  38. /* register driver and create sysfs files */
  39. ret = driver_register(&dev_info.driver);
  40. if (ret) {
  41. pr_warn("fail to register devinfo driver\n");
  42. return -1;
  43. }
  44. ret = driver_create_file(&dev_info.driver, &driver_attr_dev_info);
  45. if (ret) {
  46. pr_warn("[BOOT INIT] Fail to create devinfo sysfs file\n");
  47. driver_unregister(&dev_info.driver);
  48. return -1;
  49. }
  50. return 0;
  51. }
  52. module_init(devinfo_init);