sysfs: small header file cleanup for SYSFS=n
[linux-2.6.git] / samples / firmware_class / firmware_sample_firmware_class.c
1 /*
2  * firmware_sample_firmware_class.c -
3  *
4  * Copyright (c) 2003 Manuel Estrada Sainz
5  *
6  * NOTE: This is just a probe of concept, if you think that your driver would
7  * be well served by this mechanism please contact me first.
8  *
9  * DON'T USE THIS CODE AS IS
10  *
11  */
12
13 #include <linux/device.h>
14 #include <linux/module.h>
15 #include <linux/init.h>
16 #include <linux/timer.h>
17 #include <linux/slab.h>
18 #include <linux/string.h>
19 #include <linux/firmware.h>
20
21
22 MODULE_AUTHOR("Manuel Estrada Sainz");
23 MODULE_DESCRIPTION("Hackish sample for using firmware class directly");
24 MODULE_LICENSE("GPL");
25
26 static inline struct class_device *to_class_dev(struct kobject *obj)
27 {
28         return container_of(obj,struct class_device,kobj);
29 }
30 static inline
31 struct class_device_attribute *to_class_dev_attr(struct attribute *_attr)
32 {
33         return container_of(_attr,struct class_device_attribute,attr);
34 }
35
36 int sysfs_create_bin_file(struct kobject * kobj, struct bin_attribute * attr);
37 int sysfs_remove_bin_file(struct kobject * kobj, struct bin_attribute * attr);
38
39 struct firmware_priv {
40         char fw_id[FIRMWARE_NAME_MAX];
41         s32 loading:2;
42         u32 abort:1;
43 };
44
45 extern struct class firmware_class;
46
47 static ssize_t firmware_loading_show(struct class_device *class_dev, char *buf)
48 {
49         struct firmware_priv *fw_priv = class_get_devdata(class_dev);
50         return sprintf(buf, "%d\n", fw_priv->loading);
51 }
52 static ssize_t firmware_loading_store(struct class_device *class_dev,
53                                       const char *buf, size_t count)
54 {
55         struct firmware_priv *fw_priv = class_get_devdata(class_dev);
56         int prev_loading = fw_priv->loading;
57
58         fw_priv->loading = simple_strtol(buf, NULL, 10);
59
60         switch(fw_priv->loading){
61         case -1:
62                 /* abort load an panic */
63                 break;
64         case 1:
65                 /* setup load */
66                 break;
67         case 0:
68                 if(prev_loading==1){
69                         /* finish load and get the device back to working
70                          * state */
71                 }
72                 break;
73         }
74
75         return count;
76 }
77 static CLASS_DEVICE_ATTR(loading, 0644,
78                          firmware_loading_show, firmware_loading_store);
79
80 static ssize_t firmware_data_read(struct kobject *kobj,
81                                   struct bin_attribute *bin_attr,
82                                   char *buffer, loff_t offset, size_t count)
83 {
84         struct class_device *class_dev = to_class_dev(kobj);
85         struct firmware_priv *fw_priv = class_get_devdata(class_dev);
86
87         /* read from the devices firmware memory */
88
89         return count;
90 }
91 static ssize_t firmware_data_write(struct kobject *kobj,
92                                    struct bin_attribute *bin_attr,
93                                    char *buffer, loff_t offset, size_t count)
94 {
95         struct class_device *class_dev = to_class_dev(kobj);
96         struct firmware_priv *fw_priv = class_get_devdata(class_dev);
97
98         /* write to the devices firmware memory */
99
100         return count;
101 }
102 static struct bin_attribute firmware_attr_data = {
103         .attr = {.name = "data", .mode = 0644},
104         .size = 0,
105         .read = firmware_data_read,
106         .write = firmware_data_write,
107 };
108 static int fw_setup_class_device(struct class_device *class_dev,
109                                  const char *fw_name,
110                                  struct device *device)
111 {
112         int retval;
113         struct firmware_priv *fw_priv;
114
115         fw_priv = kzalloc(sizeof(struct firmware_priv), GFP_KERNEL);
116         if (!fw_priv) {
117                 retval = -ENOMEM;
118                 goto out;
119         }
120
121         memset(class_dev, 0, sizeof(*class_dev));
122
123         strncpy(fw_priv->fw_id, fw_name, FIRMWARE_NAME_MAX);
124         fw_priv->fw_id[FIRMWARE_NAME_MAX-1] = '\0';
125
126         strncpy(class_dev->class_id, device->bus_id, BUS_ID_SIZE);
127         class_dev->class_id[BUS_ID_SIZE-1] = '\0';
128         class_dev->dev = device;
129
130         class_dev->class = &firmware_class,
131         class_set_devdata(class_dev, fw_priv);
132         retval = class_device_register(class_dev);
133         if (retval){
134                 printk(KERN_ERR "%s: class_device_register failed\n",
135                        __FUNCTION__);
136                 goto error_free_fw_priv;
137         }
138
139         retval = sysfs_create_bin_file(&class_dev->kobj, &firmware_attr_data);
140         if (retval){
141                 printk(KERN_ERR "%s: sysfs_create_bin_file failed\n",
142                        __FUNCTION__);
143                 goto error_unreg_class_dev;
144         }
145
146         retval = class_device_create_file(class_dev,
147                                           &class_device_attr_loading);
148         if (retval){
149                 printk(KERN_ERR "%s: class_device_create_file failed\n",
150                        __FUNCTION__);
151                 goto error_remove_data;
152         }
153
154         goto out;
155
156 error_remove_data:
157         sysfs_remove_bin_file(&class_dev->kobj, &firmware_attr_data);
158 error_unreg_class_dev:
159         class_device_unregister(class_dev);
160 error_free_fw_priv:
161         kfree(fw_priv);
162 out:
163         return retval;
164 }
165 static void fw_remove_class_device(struct class_device *class_dev)
166 {
167         struct firmware_priv *fw_priv = class_get_devdata(class_dev);
168
169         class_device_remove_file(class_dev, &class_device_attr_loading);
170         sysfs_remove_bin_file(&class_dev->kobj, &firmware_attr_data);
171         class_device_unregister(class_dev);
172 }
173
174 static struct class_device *class_dev;
175
176 static struct device my_device = {
177         .bus_id    = "my_dev0",
178 };
179
180 static int __init firmware_sample_init(void)
181 {
182         int error;
183
184         device_initialize(&my_device);
185         class_dev = kmalloc(sizeof(struct class_device), GFP_KERNEL);
186         if(!class_dev)
187                 return -ENOMEM;
188
189         error = fw_setup_class_device(class_dev, "my_firmware_image",
190                                       &my_device);
191         if(error){
192                 kfree(class_dev);
193                 return error;
194         }
195         return 0;
196
197 }
198 static void __exit firmware_sample_exit(void)
199 {
200         struct firmware_priv *fw_priv = class_get_devdata(class_dev);
201         fw_remove_class_device(class_dev);
202         kfree(fw_priv);
203         kfree(class_dev);
204 }
205
206 module_init(firmware_sample_init);
207 module_exit(firmware_sample_exit);