OpenCores
URL https://opencores.org/ocsvn/or1k_soc_on_altera_embedded_dev_kit/or1k_soc_on_altera_embedded_dev_kit/trunk

Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

[/] [or1k_soc_on_altera_embedded_dev_kit/] [trunk/] [linux-2.6/] [linux-2.6.24/] [Documentation/] [firmware_class/] [firmware_sample_firmware_class.c] - Blame information for rev 17

Go to most recent revision | Details | Compare with Previous | View Log

Line No. Rev Author Line
1 3 xianfeng 
/*
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 
module_init(firmware_sample_init);
206 
module_exit(firmware_sample_exit);
207 
 

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.