1 /* 2 * soundbus 3 * 4 * Copyright 2006 Johannes Berg <johannes@sipsolutions.net> 5 * 6 * GPL v2, can be found in COPYING. 7 */ 8 9 #include <linux/module.h> 10 #include "soundbus.h" 11 12 MODULE_AUTHOR("Johannes Berg <johannes@sipsolutions.net>"); 13 MODULE_LICENSE("GPL"); 14 MODULE_DESCRIPTION("Apple Soundbus"); 15 16 struct soundbus_dev *soundbus_dev_get(struct soundbus_dev *dev) 17 { 18 struct device *tmp; 19 20 if (!dev) 21 return NULL; 22 tmp = get_device(&dev->ofdev.dev); 23 if (tmp) 24 return to_soundbus_device(tmp); 25 else 26 return NULL; 27 } 28 EXPORT_SYMBOL_GPL(soundbus_dev_get); 29 30 void soundbus_dev_put(struct soundbus_dev *dev) 31 { 32 if (dev) 33 put_device(&dev->ofdev.dev); 34 } 35 EXPORT_SYMBOL_GPL(soundbus_dev_put); 36 37 static int soundbus_probe(struct device *dev) 38 { 39 int error = -ENODEV; 40 struct soundbus_driver *drv; 41 struct soundbus_dev *soundbus_dev; 42 43 drv = to_soundbus_driver(dev->driver); 44 soundbus_dev = to_soundbus_device(dev); 45 46 if (!drv->probe) 47 return error; 48 49 soundbus_dev_get(soundbus_dev); 50 51 error = drv->probe(soundbus_dev); 52 if (error) 53 soundbus_dev_put(soundbus_dev); 54 55 return error; 56 } 57 58 59 static int soundbus_uevent(struct device *dev, struct kobj_uevent_env *env) 60 { 61 struct soundbus_dev * soundbus_dev; 62 struct platform_device * of; 63 const char *compat; 64 int retval = 0; 65 int cplen, seen = 0; 66 67 if (!dev) 68 return -ENODEV; 69 70 soundbus_dev = to_soundbus_device(dev); 71 if (!soundbus_dev) 72 return -ENODEV; 73 74 of = &soundbus_dev->ofdev; 75 76 /* stuff we want to pass to /sbin/hotplug */ 77 retval = add_uevent_var(env, "OF_NAME=%s", of->dev.of_node->name); 78 if (retval) 79 return retval; 80 81 retval = add_uevent_var(env, "OF_TYPE=%s", of->dev.of_node->type); 82 if (retval) 83 return retval; 84 85 /* Since the compatible field can contain pretty much anything 86 * it's not really legal to split it out with commas. We split it 87 * up using a number of environment variables instead. */ 88 89 compat = of_get_property(of->dev.of_node, "compatible", &cplen); 90 while (compat && cplen > 0) { 91 int tmp = env->buflen; 92 retval = add_uevent_var(env, "OF_COMPATIBLE_%d=%s", seen, compat); 93 if (retval) 94 return retval; 95 compat += env->buflen - tmp; 96 cplen -= env->buflen - tmp; 97 seen += 1; 98 } 99 100 retval = add_uevent_var(env, "OF_COMPATIBLE_N=%d", seen); 101 if (retval) 102 return retval; 103 retval = add_uevent_var(env, "MODALIAS=%s", soundbus_dev->modalias); 104 105 return retval; 106 } 107 108 static int soundbus_device_remove(struct device *dev) 109 { 110 struct soundbus_dev * soundbus_dev = to_soundbus_device(dev); 111 struct soundbus_driver * drv = to_soundbus_driver(dev->driver); 112 113 if (dev->driver && drv->remove) 114 drv->remove(soundbus_dev); 115 soundbus_dev_put(soundbus_dev); 116 117 return 0; 118 } 119 120 static void soundbus_device_shutdown(struct device *dev) 121 { 122 struct soundbus_dev * soundbus_dev = to_soundbus_device(dev); 123 struct soundbus_driver * drv = to_soundbus_driver(dev->driver); 124 125 if (dev->driver && drv->shutdown) 126 drv->shutdown(soundbus_dev); 127 } 128 129 #ifdef CONFIG_PM 130 131 static int soundbus_device_suspend(struct device *dev, pm_message_t state) 132 { 133 struct soundbus_dev * soundbus_dev = to_soundbus_device(dev); 134 struct soundbus_driver * drv = to_soundbus_driver(dev->driver); 135 136 if (dev->driver && drv->suspend) 137 return drv->suspend(soundbus_dev, state); 138 return 0; 139 } 140 141 static int soundbus_device_resume(struct device * dev) 142 { 143 struct soundbus_dev * soundbus_dev = to_soundbus_device(dev); 144 struct soundbus_driver * drv = to_soundbus_driver(dev->driver); 145 146 if (dev->driver && drv->resume) 147 return drv->resume(soundbus_dev); 148 return 0; 149 } 150 151 #endif /* CONFIG_PM */ 152 153 /* soundbus_dev_attrs is declared in sysfs.c */ 154 ATTRIBUTE_GROUPS(soundbus_dev); 155 static struct bus_type soundbus_bus_type = { 156 .name = "aoa-soundbus", 157 .probe = soundbus_probe, 158 .uevent = soundbus_uevent, 159 .remove = soundbus_device_remove, 160 .shutdown = soundbus_device_shutdown, 161 #ifdef CONFIG_PM 162 .suspend = soundbus_device_suspend, 163 .resume = soundbus_device_resume, 164 #endif 165 .dev_groups = soundbus_dev_groups, 166 }; 167 168 int soundbus_add_one(struct soundbus_dev *dev) 169 { 170 static int devcount; 171 172 /* sanity checks */ 173 if (!dev->attach_codec || 174 !dev->ofdev.dev.of_node || 175 dev->pcmname || 176 dev->pcmid != -1) { 177 printk(KERN_ERR "soundbus: adding device failed sanity check!\n"); 178 return -EINVAL; 179 } 180 181 dev_set_name(&dev->ofdev.dev, "soundbus:%x", ++devcount); 182 dev->ofdev.dev.bus = &soundbus_bus_type; 183 return of_device_register(&dev->ofdev); 184 } 185 EXPORT_SYMBOL_GPL(soundbus_add_one); 186 187 void soundbus_remove_one(struct soundbus_dev *dev) 188 { 189 of_device_unregister(&dev->ofdev); 190 } 191 EXPORT_SYMBOL_GPL(soundbus_remove_one); 192 193 int soundbus_register_driver(struct soundbus_driver *drv) 194 { 195 /* initialize common driver fields */ 196 drv->driver.name = drv->name; 197 drv->driver.bus = &soundbus_bus_type; 198 199 /* register with core */ 200 return driver_register(&drv->driver); 201 } 202 EXPORT_SYMBOL_GPL(soundbus_register_driver); 203 204 void soundbus_unregister_driver(struct soundbus_driver *drv) 205 { 206 driver_unregister(&drv->driver); 207 } 208 EXPORT_SYMBOL_GPL(soundbus_unregister_driver); 209 210 static int __init soundbus_init(void) 211 { 212 return bus_register(&soundbus_bus_type); 213 } 214 215 static void __exit soundbus_exit(void) 216 { 217 bus_unregister(&soundbus_bus_type); 218 } 219 220 subsys_initcall(soundbus_init); 221 module_exit(soundbus_exit); 222