class.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914
  1. /*
  2. * class.c - basic device class management
  3. *
  4. * Copyright (c) 2002-3 Patrick Mochel
  5. * Copyright (c) 2002-3 Open Source Development Labs
  6. * Copyright (c) 2003-2004 Greg Kroah-Hartman
  7. * Copyright (c) 2003-2004 IBM Corp.
  8. *
  9. * This file is released under the GPLv2
  10. *
  11. */
  12. #include <linux/device.h>
  13. #include <linux/module.h>
  14. #include <linux/init.h>
  15. #include <linux/string.h>
  16. #include <linux/kdev_t.h>
  17. #include <linux/err.h>
  18. #include <linux/slab.h>
  19. #include "base.h"
  20. #define to_class_attr(_attr) container_of(_attr, struct class_attribute, attr)
  21. #define to_class(obj) container_of(obj, struct class, subsys.kobj)
  22. static ssize_t
  23. class_attr_show(struct kobject * kobj, struct attribute * attr, char * buf)
  24. {
  25. struct class_attribute * class_attr = to_class_attr(attr);
  26. struct class * dc = to_class(kobj);
  27. ssize_t ret = -EIO;
  28. if (class_attr->show)
  29. ret = class_attr->show(dc, buf);
  30. return ret;
  31. }
  32. static ssize_t
  33. class_attr_store(struct kobject * kobj, struct attribute * attr,
  34. const char * buf, size_t count)
  35. {
  36. struct class_attribute * class_attr = to_class_attr(attr);
  37. struct class * dc = to_class(kobj);
  38. ssize_t ret = -EIO;
  39. if (class_attr->store)
  40. ret = class_attr->store(dc, buf, count);
  41. return ret;
  42. }
  43. static void class_release(struct kobject * kobj)
  44. {
  45. struct class *class = to_class(kobj);
  46. pr_debug("class '%s': release.\n", class->name);
  47. if (class->class_release)
  48. class->class_release(class);
  49. else
  50. pr_debug("class '%s' does not have a release() function, "
  51. "be careful\n", class->name);
  52. }
  53. static struct sysfs_ops class_sysfs_ops = {
  54. .show = class_attr_show,
  55. .store = class_attr_store,
  56. };
  57. static struct kobj_type ktype_class = {
  58. .sysfs_ops = &class_sysfs_ops,
  59. .release = class_release,
  60. };
  61. /* Hotplug events for classes go to the class_obj subsys */
  62. static decl_subsys(class, &ktype_class, NULL);
  63. int class_create_file(struct class * cls, const struct class_attribute * attr)
  64. {
  65. int error;
  66. if (cls) {
  67. error = sysfs_create_file(&cls->subsys.kobj, &attr->attr);
  68. } else
  69. error = -EINVAL;
  70. return error;
  71. }
  72. void class_remove_file(struct class * cls, const struct class_attribute * attr)
  73. {
  74. if (cls)
  75. sysfs_remove_file(&cls->subsys.kobj, &attr->attr);
  76. }
  77. static struct class *class_get(struct class *cls)
  78. {
  79. if (cls)
  80. return container_of(subsys_get(&cls->subsys), struct class, subsys);
  81. return NULL;
  82. }
  83. static void class_put(struct class * cls)
  84. {
  85. if (cls)
  86. subsys_put(&cls->subsys);
  87. }
  88. static int add_class_attrs(struct class * cls)
  89. {
  90. int i;
  91. int error = 0;
  92. if (cls->class_attrs) {
  93. for (i = 0; attr_name(cls->class_attrs[i]); i++) {
  94. error = class_create_file(cls,&cls->class_attrs[i]);
  95. if (error)
  96. goto Err;
  97. }
  98. }
  99. Done:
  100. return error;
  101. Err:
  102. while (--i >= 0)
  103. class_remove_file(cls,&cls->class_attrs[i]);
  104. goto Done;
  105. }
  106. static void remove_class_attrs(struct class * cls)
  107. {
  108. int i;
  109. if (cls->class_attrs) {
  110. for (i = 0; attr_name(cls->class_attrs[i]); i++)
  111. class_remove_file(cls,&cls->class_attrs[i]);
  112. }
  113. }
  114. int class_register(struct class * cls)
  115. {
  116. int error;
  117. pr_debug("device class '%s': registering\n", cls->name);
  118. INIT_LIST_HEAD(&cls->children);
  119. INIT_LIST_HEAD(&cls->devices);
  120. INIT_LIST_HEAD(&cls->interfaces);
  121. kset_init(&cls->class_dirs);
  122. init_MUTEX(&cls->sem);
  123. error = kobject_set_name(&cls->subsys.kobj, "%s", cls->name);
  124. if (error)
  125. return error;
  126. subsys_set_kset(cls, class_subsys);
  127. error = subsystem_register(&cls->subsys);
  128. if (!error) {
  129. error = add_class_attrs(class_get(cls));
  130. class_put(cls);
  131. }
  132. return error;
  133. }
  134. void class_unregister(struct class * cls)
  135. {
  136. pr_debug("device class '%s': unregistering\n", cls->name);
  137. remove_class_attrs(cls);
  138. subsystem_unregister(&cls->subsys);
  139. }
  140. static void class_create_release(struct class *cls)
  141. {
  142. pr_debug("%s called for %s\n", __FUNCTION__, cls->name);
  143. kfree(cls);
  144. }
  145. static void class_device_create_release(struct class_device *class_dev)
  146. {
  147. pr_debug("%s called for %s\n", __FUNCTION__, class_dev->class_id);
  148. kfree(class_dev);
  149. }
  150. /* needed to allow these devices to have parent class devices */
  151. static int class_device_create_uevent(struct class_device *class_dev,
  152. char **envp, int num_envp,
  153. char *buffer, int buffer_size)
  154. {
  155. pr_debug("%s called for %s\n", __FUNCTION__, class_dev->class_id);
  156. return 0;
  157. }
  158. /**
  159. * class_create - create a struct class structure
  160. * @owner: pointer to the module that is to "own" this struct class
  161. * @name: pointer to a string for the name of this class.
  162. *
  163. * This is used to create a struct class pointer that can then be used
  164. * in calls to class_device_create().
  165. *
  166. * Note, the pointer created here is to be destroyed when finished by
  167. * making a call to class_destroy().
  168. */
  169. struct class *class_create(struct module *owner, const char *name)
  170. {
  171. struct class *cls;
  172. int retval;
  173. cls = kzalloc(sizeof(*cls), GFP_KERNEL);
  174. if (!cls) {
  175. retval = -ENOMEM;
  176. goto error;
  177. }
  178. cls->name = name;
  179. cls->owner = owner;
  180. cls->class_release = class_create_release;
  181. cls->release = class_device_create_release;
  182. retval = class_register(cls);
  183. if (retval)
  184. goto error;
  185. return cls;
  186. error:
  187. kfree(cls);
  188. return ERR_PTR(retval);
  189. }
  190. /**
  191. * class_destroy - destroys a struct class structure
  192. * @cls: pointer to the struct class that is to be destroyed
  193. *
  194. * Note, the pointer to be destroyed must have been created with a call
  195. * to class_create().
  196. */
  197. void class_destroy(struct class *cls)
  198. {
  199. if ((cls == NULL) || (IS_ERR(cls)))
  200. return;
  201. class_unregister(cls);
  202. }
  203. /* Class Device Stuff */
  204. int class_device_create_file(struct class_device * class_dev,
  205. const struct class_device_attribute * attr)
  206. {
  207. int error = -EINVAL;
  208. if (class_dev)
  209. error = sysfs_create_file(&class_dev->kobj, &attr->attr);
  210. return error;
  211. }
  212. void class_device_remove_file(struct class_device * class_dev,
  213. const struct class_device_attribute * attr)
  214. {
  215. if (class_dev)
  216. sysfs_remove_file(&class_dev->kobj, &attr->attr);
  217. }
  218. int class_device_create_bin_file(struct class_device *class_dev,
  219. struct bin_attribute *attr)
  220. {
  221. int error = -EINVAL;
  222. if (class_dev)
  223. error = sysfs_create_bin_file(&class_dev->kobj, attr);
  224. return error;
  225. }
  226. void class_device_remove_bin_file(struct class_device *class_dev,
  227. struct bin_attribute *attr)
  228. {
  229. if (class_dev)
  230. sysfs_remove_bin_file(&class_dev->kobj, attr);
  231. }
  232. static ssize_t
  233. class_device_attr_show(struct kobject * kobj, struct attribute * attr,
  234. char * buf)
  235. {
  236. struct class_device_attribute * class_dev_attr = to_class_dev_attr(attr);
  237. struct class_device * cd = to_class_dev(kobj);
  238. ssize_t ret = 0;
  239. if (class_dev_attr->show)
  240. ret = class_dev_attr->show(cd, buf);
  241. return ret;
  242. }
  243. static ssize_t
  244. class_device_attr_store(struct kobject * kobj, struct attribute * attr,
  245. const char * buf, size_t count)
  246. {
  247. struct class_device_attribute * class_dev_attr = to_class_dev_attr(attr);
  248. struct class_device * cd = to_class_dev(kobj);
  249. ssize_t ret = 0;
  250. if (class_dev_attr->store)
  251. ret = class_dev_attr->store(cd, buf, count);
  252. return ret;
  253. }
  254. static struct sysfs_ops class_dev_sysfs_ops = {
  255. .show = class_device_attr_show,
  256. .store = class_device_attr_store,
  257. };
  258. static void class_dev_release(struct kobject * kobj)
  259. {
  260. struct class_device *cd = to_class_dev(kobj);
  261. struct class * cls = cd->class;
  262. pr_debug("device class '%s': release.\n", cd->class_id);
  263. if (cd->release)
  264. cd->release(cd);
  265. else if (cls->release)
  266. cls->release(cd);
  267. else {
  268. printk(KERN_ERR "Class Device '%s' does not have a release() function, "
  269. "it is broken and must be fixed.\n",
  270. cd->class_id);
  271. WARN_ON(1);
  272. }
  273. }
  274. static struct kobj_type ktype_class_device = {
  275. .sysfs_ops = &class_dev_sysfs_ops,
  276. .release = class_dev_release,
  277. };
  278. static int class_uevent_filter(struct kset *kset, struct kobject *kobj)
  279. {
  280. struct kobj_type *ktype = get_ktype(kobj);
  281. if (ktype == &ktype_class_device) {
  282. struct class_device *class_dev = to_class_dev(kobj);
  283. if (class_dev->class)
  284. return 1;
  285. }
  286. return 0;
  287. }
  288. static const char *class_uevent_name(struct kset *kset, struct kobject *kobj)
  289. {
  290. struct class_device *class_dev = to_class_dev(kobj);
  291. return class_dev->class->name;
  292. }
  293. #ifdef CONFIG_SYSFS_DEPRECATED
  294. char *make_class_name(const char *name, struct kobject *kobj)
  295. {
  296. char *class_name;
  297. int size;
  298. size = strlen(name) + strlen(kobject_name(kobj)) + 2;
  299. class_name = kmalloc(size, GFP_KERNEL);
  300. if (!class_name)
  301. return NULL;
  302. strcpy(class_name, name);
  303. strcat(class_name, ":");
  304. strcat(class_name, kobject_name(kobj));
  305. return class_name;
  306. }
  307. static int make_deprecated_class_device_links(struct class_device *class_dev)
  308. {
  309. char *class_name;
  310. int error;
  311. if (!class_dev->dev)
  312. return 0;
  313. class_name = make_class_name(class_dev->class->name, &class_dev->kobj);
  314. if (class_name)
  315. error = sysfs_create_link(&class_dev->dev->kobj,
  316. &class_dev->kobj, class_name);
  317. else
  318. error = -ENOMEM;
  319. kfree(class_name);
  320. return error;
  321. }
  322. static void remove_deprecated_class_device_links(struct class_device *class_dev)
  323. {
  324. char *class_name;
  325. if (!class_dev->dev)
  326. return;
  327. class_name = make_class_name(class_dev->class->name, &class_dev->kobj);
  328. if (class_name)
  329. sysfs_remove_link(&class_dev->dev->kobj, class_name);
  330. kfree(class_name);
  331. }
  332. #else
  333. static inline int make_deprecated_class_device_links(struct class_device *cd)
  334. { return 0; }
  335. static void remove_deprecated_class_device_links(struct class_device *cd)
  336. { }
  337. #endif
  338. static int class_uevent(struct kset *kset, struct kobject *kobj, char **envp,
  339. int num_envp, char *buffer, int buffer_size)
  340. {
  341. struct class_device *class_dev = to_class_dev(kobj);
  342. struct device *dev = class_dev->dev;
  343. int i = 0;
  344. int length = 0;
  345. int retval = 0;
  346. pr_debug("%s - name = %s\n", __FUNCTION__, class_dev->class_id);
  347. if (MAJOR(class_dev->devt)) {
  348. add_uevent_var(envp, num_envp, &i,
  349. buffer, buffer_size, &length,
  350. "MAJOR=%u", MAJOR(class_dev->devt));
  351. add_uevent_var(envp, num_envp, &i,
  352. buffer, buffer_size, &length,
  353. "MINOR=%u", MINOR(class_dev->devt));
  354. }
  355. if (dev) {
  356. const char *path = kobject_get_path(&dev->kobj, GFP_KERNEL);
  357. if (path) {
  358. add_uevent_var(envp, num_envp, &i,
  359. buffer, buffer_size, &length,
  360. "PHYSDEVPATH=%s", path);
  361. kfree(path);
  362. }
  363. if (dev->bus)
  364. add_uevent_var(envp, num_envp, &i,
  365. buffer, buffer_size, &length,
  366. "PHYSDEVBUS=%s", dev->bus->name);
  367. if (dev->driver)
  368. add_uevent_var(envp, num_envp, &i,
  369. buffer, buffer_size, &length,
  370. "PHYSDEVDRIVER=%s", dev->driver->name);
  371. }
  372. /* terminate, set to next free slot, shrink available space */
  373. envp[i] = NULL;
  374. envp = &envp[i];
  375. num_envp -= i;
  376. buffer = &buffer[length];
  377. buffer_size -= length;
  378. if (class_dev->uevent) {
  379. /* have the class device specific function add its stuff */
  380. retval = class_dev->uevent(class_dev, envp, num_envp,
  381. buffer, buffer_size);
  382. if (retval)
  383. pr_debug("class_dev->uevent() returned %d\n", retval);
  384. } else if (class_dev->class->uevent) {
  385. /* have the class specific function add its stuff */
  386. retval = class_dev->class->uevent(class_dev, envp, num_envp,
  387. buffer, buffer_size);
  388. if (retval)
  389. pr_debug("class->uevent() returned %d\n", retval);
  390. }
  391. return retval;
  392. }
  393. static struct kset_uevent_ops class_uevent_ops = {
  394. .filter = class_uevent_filter,
  395. .name = class_uevent_name,
  396. .uevent = class_uevent,
  397. };
  398. static decl_subsys(class_obj, &ktype_class_device, &class_uevent_ops);
  399. static int class_device_add_attrs(struct class_device * cd)
  400. {
  401. int i;
  402. int error = 0;
  403. struct class * cls = cd->class;
  404. if (cls->class_dev_attrs) {
  405. for (i = 0; attr_name(cls->class_dev_attrs[i]); i++) {
  406. error = class_device_create_file(cd,
  407. &cls->class_dev_attrs[i]);
  408. if (error)
  409. goto Err;
  410. }
  411. }
  412. Done:
  413. return error;
  414. Err:
  415. while (--i >= 0)
  416. class_device_remove_file(cd,&cls->class_dev_attrs[i]);
  417. goto Done;
  418. }
  419. static void class_device_remove_attrs(struct class_device * cd)
  420. {
  421. int i;
  422. struct class * cls = cd->class;
  423. if (cls->class_dev_attrs) {
  424. for (i = 0; attr_name(cls->class_dev_attrs[i]); i++)
  425. class_device_remove_file(cd,&cls->class_dev_attrs[i]);
  426. }
  427. }
  428. static int class_device_add_groups(struct class_device * cd)
  429. {
  430. int i;
  431. int error = 0;
  432. if (cd->groups) {
  433. for (i = 0; cd->groups[i]; i++) {
  434. error = sysfs_create_group(&cd->kobj, cd->groups[i]);
  435. if (error) {
  436. while (--i >= 0)
  437. sysfs_remove_group(&cd->kobj, cd->groups[i]);
  438. goto out;
  439. }
  440. }
  441. }
  442. out:
  443. return error;
  444. }
  445. static void class_device_remove_groups(struct class_device * cd)
  446. {
  447. int i;
  448. if (cd->groups) {
  449. for (i = 0; cd->groups[i]; i++) {
  450. sysfs_remove_group(&cd->kobj, cd->groups[i]);
  451. }
  452. }
  453. }
  454. static ssize_t show_dev(struct class_device *class_dev, char *buf)
  455. {
  456. return print_dev_t(buf, class_dev->devt);
  457. }
  458. static struct class_device_attribute class_devt_attr =
  459. __ATTR(dev, S_IRUGO, show_dev, NULL);
  460. static ssize_t store_uevent(struct class_device *class_dev,
  461. const char *buf, size_t count)
  462. {
  463. kobject_uevent(&class_dev->kobj, KOBJ_ADD);
  464. return count;
  465. }
  466. static struct class_device_attribute class_uevent_attr =
  467. __ATTR(uevent, S_IWUSR, NULL, store_uevent);
  468. void class_device_initialize(struct class_device *class_dev)
  469. {
  470. kobj_set_kset_s(class_dev, class_obj_subsys);
  471. kobject_init(&class_dev->kobj);
  472. INIT_LIST_HEAD(&class_dev->node);
  473. }
  474. int class_device_add(struct class_device *class_dev)
  475. {
  476. struct class *parent_class = NULL;
  477. struct class_device *parent_class_dev = NULL;
  478. struct class_interface *class_intf;
  479. int error = -EINVAL;
  480. class_dev = class_device_get(class_dev);
  481. if (!class_dev)
  482. return -EINVAL;
  483. if (!strlen(class_dev->class_id))
  484. goto out1;
  485. parent_class = class_get(class_dev->class);
  486. if (!parent_class)
  487. goto out1;
  488. parent_class_dev = class_device_get(class_dev->parent);
  489. pr_debug("CLASS: registering class device: ID = '%s'\n",
  490. class_dev->class_id);
  491. /* first, register with generic layer. */
  492. error = kobject_set_name(&class_dev->kobj, "%s", class_dev->class_id);
  493. if (error)
  494. goto out2;
  495. if (parent_class_dev)
  496. class_dev->kobj.parent = &parent_class_dev->kobj;
  497. else
  498. class_dev->kobj.parent = &parent_class->subsys.kobj;
  499. error = kobject_add(&class_dev->kobj);
  500. if (error)
  501. goto out2;
  502. /* add the needed attributes to this device */
  503. error = sysfs_create_link(&class_dev->kobj,
  504. &parent_class->subsys.kobj, "subsystem");
  505. if (error)
  506. goto out3;
  507. error = class_device_create_file(class_dev, &class_uevent_attr);
  508. if (error)
  509. goto out3;
  510. if (MAJOR(class_dev->devt)) {
  511. error = class_device_create_file(class_dev, &class_devt_attr);
  512. if (error)
  513. goto out4;
  514. }
  515. error = class_device_add_attrs(class_dev);
  516. if (error)
  517. goto out5;
  518. if (class_dev->dev) {
  519. error = sysfs_create_link(&class_dev->kobj,
  520. &class_dev->dev->kobj, "device");
  521. if (error)
  522. goto out6;
  523. }
  524. error = class_device_add_groups(class_dev);
  525. if (error)
  526. goto out7;
  527. error = make_deprecated_class_device_links(class_dev);
  528. if (error)
  529. goto out8;
  530. kobject_uevent(&class_dev->kobj, KOBJ_ADD);
  531. /* notify any interfaces this device is now here */
  532. down(&parent_class->sem);
  533. list_add_tail(&class_dev->node, &parent_class->children);
  534. list_for_each_entry(class_intf, &parent_class->interfaces, node) {
  535. if (class_intf->add)
  536. class_intf->add(class_dev, class_intf);
  537. }
  538. up(&parent_class->sem);
  539. goto out1;
  540. out8:
  541. class_device_remove_groups(class_dev);
  542. out7:
  543. if (class_dev->dev)
  544. sysfs_remove_link(&class_dev->kobj, "device");
  545. out6:
  546. class_device_remove_attrs(class_dev);
  547. out5:
  548. if (MAJOR(class_dev->devt))
  549. class_device_remove_file(class_dev, &class_devt_attr);
  550. out4:
  551. class_device_remove_file(class_dev, &class_uevent_attr);
  552. out3:
  553. kobject_del(&class_dev->kobj);
  554. out2:
  555. if(parent_class_dev)
  556. class_device_put(parent_class_dev);
  557. class_put(parent_class);
  558. out1:
  559. class_device_put(class_dev);
  560. return error;
  561. }
  562. int class_device_register(struct class_device *class_dev)
  563. {
  564. class_device_initialize(class_dev);
  565. return class_device_add(class_dev);
  566. }
  567. /**
  568. * class_device_create - creates a class device and registers it with sysfs
  569. * @cls: pointer to the struct class that this device should be registered to.
  570. * @parent: pointer to the parent struct class_device of this new device, if any.
  571. * @devt: the dev_t for the char device to be added.
  572. * @device: a pointer to a struct device that is assiociated with this class device.
  573. * @fmt: string for the class device's name
  574. *
  575. * This function can be used by char device classes. A struct
  576. * class_device will be created in sysfs, registered to the specified
  577. * class.
  578. * A "dev" file will be created, showing the dev_t for the device, if
  579. * the dev_t is not 0,0.
  580. * If a pointer to a parent struct class_device is passed in, the newly
  581. * created struct class_device will be a child of that device in sysfs.
  582. * The pointer to the struct class_device will be returned from the
  583. * call. Any further sysfs files that might be required can be created
  584. * using this pointer.
  585. *
  586. * Note: the struct class passed to this function must have previously
  587. * been created with a call to class_create().
  588. */
  589. struct class_device *class_device_create(struct class *cls,
  590. struct class_device *parent,
  591. dev_t devt,
  592. struct device *device,
  593. const char *fmt, ...)
  594. {
  595. va_list args;
  596. struct class_device *class_dev = NULL;
  597. int retval = -ENODEV;
  598. if (cls == NULL || IS_ERR(cls))
  599. goto error;
  600. class_dev = kzalloc(sizeof(*class_dev), GFP_KERNEL);
  601. if (!class_dev) {
  602. retval = -ENOMEM;
  603. goto error;
  604. }
  605. class_dev->devt = devt;
  606. class_dev->dev = device;
  607. class_dev->class = cls;
  608. class_dev->parent = parent;
  609. class_dev->release = class_device_create_release;
  610. class_dev->uevent = class_device_create_uevent;
  611. va_start(args, fmt);
  612. vsnprintf(class_dev->class_id, BUS_ID_SIZE, fmt, args);
  613. va_end(args);
  614. retval = class_device_register(class_dev);
  615. if (retval)
  616. goto error;
  617. return class_dev;
  618. error:
  619. kfree(class_dev);
  620. return ERR_PTR(retval);
  621. }
  622. void class_device_del(struct class_device *class_dev)
  623. {
  624. struct class *parent_class = class_dev->class;
  625. struct class_device *parent_device = class_dev->parent;
  626. struct class_interface *class_intf;
  627. if (parent_class) {
  628. down(&parent_class->sem);
  629. list_del_init(&class_dev->node);
  630. list_for_each_entry(class_intf, &parent_class->interfaces, node)
  631. if (class_intf->remove)
  632. class_intf->remove(class_dev, class_intf);
  633. up(&parent_class->sem);
  634. }
  635. if (class_dev->dev) {
  636. remove_deprecated_class_device_links(class_dev);
  637. sysfs_remove_link(&class_dev->kobj, "device");
  638. }
  639. sysfs_remove_link(&class_dev->kobj, "subsystem");
  640. class_device_remove_file(class_dev, &class_uevent_attr);
  641. if (MAJOR(class_dev->devt))
  642. class_device_remove_file(class_dev, &class_devt_attr);
  643. class_device_remove_attrs(class_dev);
  644. class_device_remove_groups(class_dev);
  645. kobject_uevent(&class_dev->kobj, KOBJ_REMOVE);
  646. kobject_del(&class_dev->kobj);
  647. class_device_put(parent_device);
  648. class_put(parent_class);
  649. }
  650. void class_device_unregister(struct class_device *class_dev)
  651. {
  652. pr_debug("CLASS: Unregistering class device. ID = '%s'\n",
  653. class_dev->class_id);
  654. class_device_del(class_dev);
  655. class_device_put(class_dev);
  656. }
  657. /**
  658. * class_device_destroy - removes a class device that was created with class_device_create()
  659. * @cls: the pointer to the struct class that this device was registered * with.
  660. * @devt: the dev_t of the device that was previously registered.
  661. *
  662. * This call unregisters and cleans up a class device that was created with a
  663. * call to class_device_create()
  664. */
  665. void class_device_destroy(struct class *cls, dev_t devt)
  666. {
  667. struct class_device *class_dev = NULL;
  668. struct class_device *class_dev_tmp;
  669. down(&cls->sem);
  670. list_for_each_entry(class_dev_tmp, &cls->children, node) {
  671. if (class_dev_tmp->devt == devt) {
  672. class_dev = class_dev_tmp;
  673. break;
  674. }
  675. }
  676. up(&cls->sem);
  677. if (class_dev)
  678. class_device_unregister(class_dev);
  679. }
  680. struct class_device * class_device_get(struct class_device *class_dev)
  681. {
  682. if (class_dev)
  683. return to_class_dev(kobject_get(&class_dev->kobj));
  684. return NULL;
  685. }
  686. void class_device_put(struct class_device *class_dev)
  687. {
  688. if (class_dev)
  689. kobject_put(&class_dev->kobj);
  690. }
  691. int class_interface_register(struct class_interface *class_intf)
  692. {
  693. struct class *parent;
  694. struct class_device *class_dev;
  695. struct device *dev;
  696. if (!class_intf || !class_intf->class)
  697. return -ENODEV;
  698. parent = class_get(class_intf->class);
  699. if (!parent)
  700. return -EINVAL;
  701. down(&parent->sem);
  702. list_add_tail(&class_intf->node, &parent->interfaces);
  703. if (class_intf->add) {
  704. list_for_each_entry(class_dev, &parent->children, node)
  705. class_intf->add(class_dev, class_intf);
  706. }
  707. if (class_intf->add_dev) {
  708. list_for_each_entry(dev, &parent->devices, node)
  709. class_intf->add_dev(dev, class_intf);
  710. }
  711. up(&parent->sem);
  712. return 0;
  713. }
  714. void class_interface_unregister(struct class_interface *class_intf)
  715. {
  716. struct class * parent = class_intf->class;
  717. struct class_device *class_dev;
  718. struct device *dev;
  719. if (!parent)
  720. return;
  721. down(&parent->sem);
  722. list_del_init(&class_intf->node);
  723. if (class_intf->remove) {
  724. list_for_each_entry(class_dev, &parent->children, node)
  725. class_intf->remove(class_dev, class_intf);
  726. }
  727. if (class_intf->remove_dev) {
  728. list_for_each_entry(dev, &parent->devices, node)
  729. class_intf->remove_dev(dev, class_intf);
  730. }
  731. up(&parent->sem);
  732. class_put(parent);
  733. }
  734. int __init classes_init(void)
  735. {
  736. int retval;
  737. retval = subsystem_register(&class_subsys);
  738. if (retval)
  739. return retval;
  740. /* ick, this is ugly, the things we go through to keep from showing up
  741. * in sysfs... */
  742. subsystem_init(&class_obj_subsys);
  743. if (!class_obj_subsys.kobj.parent)
  744. class_obj_subsys.kobj.parent = &class_obj_subsys.kobj;
  745. return 0;
  746. }
  747. EXPORT_SYMBOL_GPL(class_create_file);
  748. EXPORT_SYMBOL_GPL(class_remove_file);
  749. EXPORT_SYMBOL_GPL(class_register);
  750. EXPORT_SYMBOL_GPL(class_unregister);
  751. EXPORT_SYMBOL_GPL(class_create);
  752. EXPORT_SYMBOL_GPL(class_destroy);
  753. EXPORT_SYMBOL_GPL(class_device_register);
  754. EXPORT_SYMBOL_GPL(class_device_unregister);
  755. EXPORT_SYMBOL_GPL(class_device_initialize);
  756. EXPORT_SYMBOL_GPL(class_device_add);
  757. EXPORT_SYMBOL_GPL(class_device_del);
  758. EXPORT_SYMBOL_GPL(class_device_get);
  759. EXPORT_SYMBOL_GPL(class_device_put);
  760. EXPORT_SYMBOL_GPL(class_device_create);
  761. EXPORT_SYMBOL_GPL(class_device_destroy);
  762. EXPORT_SYMBOL_GPL(class_device_create_file);
  763. EXPORT_SYMBOL_GPL(class_device_remove_file);
  764. EXPORT_SYMBOL_GPL(class_device_create_bin_file);
  765. EXPORT_SYMBOL_GPL(class_device_remove_bin_file);
  766. EXPORT_SYMBOL_GPL(class_interface_register);
  767. EXPORT_SYMBOL_GPL(class_interface_unregister);