device.c 10.4 KB
Newer Older
1 2 3
/*
 * File      : device.c
 * This file is part of RT-Thread RTOS
D
dzzxzz 已提交
4
 * COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
5
 *
B
Bernard Xiong 已提交
6 7 8 9 10 11 12 13 14 15 16 17 18
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
19 20 21 22
 *
 * Change Logs:
 * Date           Author       Notes
 * 2007-01-21     Bernard      the first version
B
bernard.xiong 已提交
23
 * 2010-05-04     Bernard      add rt_device_init implementation
B
Bernard Xiong 已提交
24
 * 2012-10-20     Bernard      add device check in register function,
25
 *                             provided by Rob <rdent@iinet.net.au>
26
 * 2012-12-25     Bernard      return RT_EOK if the device interface not exist.
27 28 29 30 31 32 33 34 35 36 37 38 39 40 41
 */

#include <rtthread.h>

#ifdef RT_USING_DEVICE

/**
 * This function registers a device driver with specified name.
 *
 * @param dev the pointer of device driver structure
 * @param name the device driver's name
 * @param flags the flag of device
 *
 * @return the error code, RT_EOK on initialization successfully.
 */
42 43 44
rt_err_t rt_device_register(rt_device_t dev,
                            const char *name,
                            rt_uint16_t flags)
45
{
46 47
    if (dev == RT_NULL)
        return -RT_ERROR;
48

49 50
    if (rt_device_find(name) != RT_NULL)
        return -RT_ERROR;
51

52 53
    rt_object_init(&(dev->parent), RT_Object_Class_Device, name);
    dev->flag = flags;
54

55
    return RT_EOK;
56
}
57
RTM_EXPORT(rt_device_register);
58 59

/**
B
bernard.xiong@gmail.com 已提交
60
 * This function removes a previously registered device driver
61 62 63 64 65 66 67
 *
 * @param dev the pointer of device driver structure
 *
 * @return the error code, RT_EOK on successfully.
 */
rt_err_t rt_device_unregister(rt_device_t dev)
{
68
    RT_ASSERT(dev != RT_NULL);
69

70
    rt_object_detach(&(dev->parent));
71

72
    return RT_EOK;
73
}
74
RTM_EXPORT(rt_device_unregister);
75 76 77 78 79 80

/**
 * This function initializes all registered device driver
 *
 * @return the error code, RT_EOK on successfully.
 */
D
dzzxzz 已提交
81
rt_err_t rt_device_init_all(void)
82
{
83 84 85 86 87 88 89 90 91 92
    struct rt_device *device;
    struct rt_list_node *node;
    struct rt_object_information *information;
    register rt_err_t result;

    extern struct rt_object_information rt_object_container[];

    information = &rt_object_container[RT_Object_Class_Device];

    /* for each device */
93 94 95
    for (node  = information->object_list.next;
         node != &(information->object_list);
         node  = node->next)
96 97
    {
        rt_err_t (*init)(rt_device_t dev);
98 99 100
        device = (struct rt_device *)rt_list_entry(node,
                                                   struct rt_object,
                                                   list);
101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119

        /* get device init handler */
        init = device->init;
        if (init != RT_NULL && !(device->flag & RT_DEVICE_FLAG_ACTIVATED))
        {
            result = init(device);
            if (result != RT_EOK)
            {
                rt_kprintf("To initialize device:%s failed. The error code is %d\n",
                           device->parent.name, result);
            }
            else
            {
                device->flag |= RT_DEVICE_FLAG_ACTIVATED;
            }
        }
    }

    return RT_EOK;
120 121 122 123 124 125 126 127 128
}

/**
 * This function finds a device driver by specified name.
 *
 * @param name the device driver's name
 *
 * @return the registered device driver on successful, or RT_NULL on failure.
 */
D
dzzxzz 已提交
129
rt_device_t rt_device_find(const char *name)
130
{
131 132 133 134 135 136 137 138 139 140 141 142
    struct rt_object *object;
    struct rt_list_node *node;
    struct rt_object_information *information;

    extern struct rt_object_information rt_object_container[];

    /* enter critical */
    if (rt_thread_self() != RT_NULL)
        rt_enter_critical();

    /* try to find device object */
    information = &rt_object_container[RT_Object_Class_Device];
143 144 145
    for (node  = information->object_list.next;
         node != &(information->object_list);
         node  = node->next)
146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163
    {
        object = rt_list_entry(node, struct rt_object, list);
        if (rt_strncmp(object->name, name, RT_NAME_MAX) == 0)
        {
            /* leave critical */
            if (rt_thread_self() != RT_NULL)
                rt_exit_critical();

            return (rt_device_t)object;
        }
    }

    /* leave critical */
    if (rt_thread_self() != RT_NULL)
        rt_exit_critical();

    /* not found */
    return RT_NULL;
B
bernard.xiong 已提交
164
}
165
RTM_EXPORT(rt_device_find);
B
bernard.xiong 已提交
166 167

/**
B
bernard.xiong@gmail.com 已提交
168
 * This function will initialize the specified device
B
bernard.xiong 已提交
169 170
 *
 * @param dev the pointer of device driver structure
B
Bernard Xiong 已提交
171
 *
B
bernard.xiong 已提交
172 173 174 175
 * @return the result
 */
rt_err_t rt_device_init(rt_device_t dev)
{
176
    rt_err_t result = RT_EOK;
177

178 179 180
    RT_ASSERT(dev != RT_NULL);

    /* get device init handler */
181
    if (dev->init != RT_NULL)
182 183 184
    {
        if (!(dev->flag & RT_DEVICE_FLAG_ACTIVATED))
        {
185
            result = dev->init(dev);
186 187 188 189 190 191 192 193 194 195 196 197 198
            if (result != RT_EOK)
            {
                rt_kprintf("To initialize device:%s failed. The error code is %d\n",
                           dev->parent.name, result);
            }
            else
            {
                dev->flag |= RT_DEVICE_FLAG_ACTIVATED;
            }
        }
    }

    return result;
199 200 201 202 203 204
}

/**
 * This function will open a device
 *
 * @param dev the pointer of device driver structure
B
bernard.xiong@gmail.com 已提交
205
 * @param oflag the flags for device open
206 207 208 209 210
 *
 * @return the result
 */
rt_err_t rt_device_open(rt_device_t dev, rt_uint16_t oflag)
{
211
    rt_err_t result = RT_EOK;
212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233

    RT_ASSERT(dev != RT_NULL);

    /* if device is not initialized, initialize it. */
    if (!(dev->flag & RT_DEVICE_FLAG_ACTIVATED))
    {
        if (dev->init != RT_NULL)
        {
            result = dev->init(dev);
            if (result != RT_EOK)
            {
                rt_kprintf("To initialize device:%s failed. The error code is %d\n",
                           dev->parent.name, result);

                return result;
            }
        }

        dev->flag |= RT_DEVICE_FLAG_ACTIVATED;
    }

    /* device is a stand alone device and opened */
234 235 236
    if ((dev->flag & RT_DEVICE_FLAG_STANDALONE) &&
        (dev->open_flag & RT_DEVICE_OFLAG_OPEN))
    {
237
        return -RT_EBUSY;
238
    }
239 240

    /* call device open interface */
241
    if (dev->open != RT_NULL)
242
    {
243
        result = dev->open(dev, oflag);
244 245 246 247 248 249 250
    }

    /* set open flag */
    if (result == RT_EOK || result == -RT_ENOSYS)
        dev->open_flag = oflag | RT_DEVICE_OFLAG_OPEN;

    return result;
251
}
252
RTM_EXPORT(rt_device_open);
253 254 255 256 257 258 259 260 261 262

/**
 * This function will close a device
 *
 * @param dev the pointer of device driver structure
 *
 * @return the result
 */
rt_err_t rt_device_close(rt_device_t dev)
{
263
    rt_err_t result = RT_EOK;
264 265 266 267

    RT_ASSERT(dev != RT_NULL);

    /* call device close interface */
268
    if (dev->close != RT_NULL)
269
    {
270
        result = dev->close(dev);
271 272 273 274 275 276 277
    }

    /* set open flag */
    if (result == RT_EOK || result == -RT_ENOSYS)
        dev->open_flag = RT_DEVICE_OFLAG_CLOSE;

    return result;
278
}
279
RTM_EXPORT(rt_device_close);
280 281 282 283 284 285 286 287 288 289

/**
 * This function will read some data from a device.
 *
 * @param dev the pointer of device driver structure
 * @param pos the position of reading
 * @param buffer the data buffer to save read data
 * @param size the size of buffer
 *
 * @return the actually read size on successful, otherwise negative returned.
B
bernard.xiong@gmail.com 已提交
290 291
 *
 * @note since 0.4.0, the unit of size/pos is a block for block device.
292
 */
293 294 295 296
rt_size_t rt_device_read(rt_device_t dev,
                         rt_off_t    pos,
                         void       *buffer,
                         rt_size_t   size)
297
{
298
    RT_ASSERT(dev != RT_NULL);
299

300
    /* call device read interface */
301
    if (dev->read != RT_NULL)
302
    {
303
        return dev->read(dev, pos, buffer, size);
304
    }
305

306 307
    /* set error code */
    rt_set_errno(-RT_ENOSYS);
D
dzzxzz 已提交
308

309
    return 0;
310
}
311
RTM_EXPORT(rt_device_read);
312 313 314 315 316 317 318 319 320 321

/**
 * This function will write some data to a device.
 *
 * @param dev the pointer of device driver structure
 * @param pos the position of written
 * @param buffer the data buffer to be written to device
 * @param size the size of buffer
 *
 * @return the actually written size on successful, otherwise negative returned.
B
bernard.xiong@gmail.com 已提交
322 323
 *
 * @note since 0.4.0, the unit of size/pos is a block for block device.
324
 */
325 326 327 328
rt_size_t rt_device_write(rt_device_t dev,
                          rt_off_t    pos,
                          const void *buffer,
                          rt_size_t   size)
329
{
330
    RT_ASSERT(dev != RT_NULL);
331

332
    /* call device write interface */
333
    if (dev->write != RT_NULL)
334
    {
335
        return dev->write(dev, pos, buffer, size);
336
    }
337

338 339
    /* set error code */
    rt_set_errno(-RT_ENOSYS);
D
dzzxzz 已提交
340

341
    return 0;
342
}
343
RTM_EXPORT(rt_device_write);
344 345 346 347 348 349 350 351 352 353

/**
 * This function will perform a variety of control functions on devices.
 *
 * @param dev the pointer of device driver structure
 * @param cmd the command sent to device
 * @param arg the argument of command
 *
 * @return the result
 */
D
dzzxzz 已提交
354
rt_err_t rt_device_control(rt_device_t dev, rt_uint8_t cmd, void *arg)
355
{
356
    RT_ASSERT(dev != RT_NULL);
357

358
    /* call device write interface */
359
    if (dev->control != RT_NULL)
360
    {
361
        return dev->control(dev, cmd, arg);
362
    }
363

364
    return RT_EOK;
365
}
366
RTM_EXPORT(rt_device_control);
367

B
bernard.xiong@gmail.com 已提交
368 369 370 371 372 373 374 375 376
/**
 * This function will set the indication callback function when device receives
 * data.
 *
 * @param dev the pointer of device driver structure
 * @param rx_ind the indication callback function
 *
 * @return RT_EOK
 */
377 378 379
rt_err_t
rt_device_set_rx_indicate(rt_device_t dev,
                          rt_err_t (*rx_ind)(rt_device_t dev, rt_size_t size))
380
{
381
    RT_ASSERT(dev != RT_NULL);
382

383
    dev->rx_indicate = rx_ind;
D
dzzxzz 已提交
384

385
    return RT_EOK;
386
}
387
RTM_EXPORT(rt_device_set_rx_indicate);
388

B
bernard.xiong@gmail.com 已提交
389
/**
B
Bernard Xiong 已提交
390
 * This function will set the indication callback function when device has
391
 * written data to physical hardware.
B
bernard.xiong@gmail.com 已提交
392 393 394 395 396 397
 *
 * @param dev the pointer of device driver structure
 * @param tx_done the indication callback function
 *
 * @return RT_EOK
 */
398 399 400
rt_err_t
rt_device_set_tx_complete(rt_device_t dev,
                          rt_err_t (*tx_done)(rt_device_t dev, void *buffer))
401
{
402
    RT_ASSERT(dev != RT_NULL);
403

404
    dev->tx_complete = tx_done;
D
dzzxzz 已提交
405

406
    return RT_EOK;
407
}
408
RTM_EXPORT(rt_device_set_tx_complete);
409 410

#endif