device.c 11.3 KB
Newer Older
1 2 3
/*
 * File      : device.c
 * This file is part of RT-Thread RTOS
G
Grissiom 已提交
4
 * COPYRIGHT (C) 2006 - 2013, 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.
G
Grissiom 已提交
27
 * 2013-07-09     Grissiom     add ref_count support
28
 * 2016-04-02     Bernard      fix the open_flag initialization issue.
29 30 31 32 33 34 35 36 37 38 39 40 41 42 43
 */

#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.
 */
44 45 46
rt_err_t rt_device_register(rt_device_t dev,
                            const char *name,
                            rt_uint16_t flags)
47
{
48 49
    if (dev == RT_NULL)
        return -RT_ERROR;
50

51 52
    if (rt_device_find(name) != RT_NULL)
        return -RT_ERROR;
53

54 55
    rt_object_init(&(dev->parent), RT_Object_Class_Device, name);
    dev->flag = flags;
G
Grissiom 已提交
56
    dev->ref_count = 0;
57
    dev->open_flag = 0;
58

B
bernard 已提交
59
#if defined(RT_USING_POSIX)
B
bernard 已提交
60 61 62 63
    dev->fops = RT_NULL;
    rt_list_init(&(dev->wait_queue));
#endif

64
    return RT_EOK;
65
}
66
RTM_EXPORT(rt_device_register);
67 68

/**
B
bernard.xiong@gmail.com 已提交
69
 * This function removes a previously registered device driver
70 71 72 73 74 75 76
 *
 * @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)
{
77
    RT_ASSERT(dev != RT_NULL);
78

79
    rt_object_detach(&(dev->parent));
80

81
    return RT_EOK;
82
}
83
RTM_EXPORT(rt_device_unregister);
84 85 86 87 88

/**
 * This function initializes all registered device driver
 *
 * @return the error code, RT_EOK on successfully.
89
 *
90
 * @deprecated since 1.2.x, this function is not needed because the initialization
91
 *             of a device is performed when applicaiton opens it.
92
 */
D
dzzxzz 已提交
93
rt_err_t rt_device_init_all(void)
94
{
95
    return RT_EOK;
96 97 98 99 100 101 102 103 104
}

/**
 * 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 已提交
105
rt_device_t rt_device_find(const char *name)
106
{
107 108 109 110 111 112 113 114 115
    struct rt_object *object;
    struct rt_list_node *node;
    struct rt_object_information *information;

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

    /* try to find device object */
116 117
    information = rt_object_get_information(RT_Object_Class_Device);
    RT_ASSERT(information != RT_NULL);
118 119 120
    for (node  = information->object_list.next;
         node != &(information->object_list);
         node  = node->next)
121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138
    {
        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 已提交
139
}
140
RTM_EXPORT(rt_device_find);
B
bernard.xiong 已提交
141

142 143 144 145 146 147 148 149 150 151 152
#ifdef RT_USING_HEAP
/**
 * This function creates a device object with user data size.
 *
 * @param type, the kind type of this device object.
 * @param attach_size, the size of user data.
 *
 * @return the allocated device object, or RT_NULL when failed.
 */
rt_device_t rt_device_create(int type, int attach_size)
{
B
BernardXiong 已提交
153 154
    int size;
    rt_device_t device;
155

B
BernardXiong 已提交
156 157
    size = RT_ALIGN(sizeof(struct rt_device), RT_ALIGN_SIZE);
    size += attach_size;
158

B
BernardXiong 已提交
159 160 161 162 163 164
    device = (rt_device_t)rt_malloc(size);
    if (device)
    {
        rt_memset(device, 0x0, sizeof(struct rt_device));
        device->type = (enum rt_device_class_type)type;
    }
165

B
BernardXiong 已提交
166
    return device;
167 168 169 170 171 172 173 174 175 176
}
RTM_EXPORT(rt_device_create);

/**
 * This function destroy the specific device object.
 *
 * @param device, the specific device object.
 */
void rt_device_destroy(rt_device_t device)
{
B
BernardXiong 已提交
177 178
    /* unregister device firstly */
    rt_device_unregister(device);
179

B
BernardXiong 已提交
180 181
    /* release this device object */
    rt_free(device);
182 183 184 185
}
RTM_EXPORT(rt_device_destroy);
#endif

B
bernard.xiong 已提交
186
/**
B
bernard.xiong@gmail.com 已提交
187
 * This function will initialize the specified device
B
bernard.xiong 已提交
188 189
 *
 * @param dev the pointer of device driver structure
B
Bernard Xiong 已提交
190
 *
B
bernard.xiong 已提交
191 192 193 194
 * @return the result
 */
rt_err_t rt_device_init(rt_device_t dev)
{
195
    rt_err_t result = RT_EOK;
196

197 198 199
    RT_ASSERT(dev != RT_NULL);

    /* get device init handler */
200
    if (dev->init != RT_NULL)
201 202 203
    {
        if (!(dev->flag & RT_DEVICE_FLAG_ACTIVATED))
        {
204
            result = dev->init(dev);
205 206 207 208 209 210 211 212 213 214 215 216 217
            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;
218 219 220 221 222 223
}

/**
 * This function will open a device
 *
 * @param dev the pointer of device driver structure
B
bernard.xiong@gmail.com 已提交
224
 * @param oflag the flags for device open
225 226 227 228 229
 *
 * @return the result
 */
rt_err_t rt_device_open(rt_device_t dev, rt_uint16_t oflag)
{
230
    rt_err_t result = RT_EOK;
231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252

    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 */
253 254 255
    if ((dev->flag & RT_DEVICE_FLAG_STANDALONE) &&
        (dev->open_flag & RT_DEVICE_OFLAG_OPEN))
    {
256
        return -RT_EBUSY;
257
    }
258 259

    /* call device open interface */
260
    if (dev->open != RT_NULL)
261
    {
262
        result = dev->open(dev, oflag);
263
    }
B
bernard 已提交
264 265 266 267 268
    else
    {
        /* set open flag */
        dev->open_flag = (oflag & RT_DEVICE_OFLAG_MASK);
    }
269 270 271

    /* set open flag */
    if (result == RT_EOK || result == -RT_ENOSYS)
272
    {
B
bernard 已提交
273
        dev->open_flag |= RT_DEVICE_OFLAG_OPEN;
274 275 276 277 278 279

        dev->ref_count++;
        /* don't let bad things happen silently. If you are bitten by this assert,
         * please set the ref_count to a bigger type. */
        RT_ASSERT(dev->ref_count != 0);
    }
280 281

    return result;
282
}
283
RTM_EXPORT(rt_device_open);
284 285 286 287 288 289 290 291 292 293

/**
 * 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)
{
294
    rt_err_t result = RT_EOK;
295 296 297

    RT_ASSERT(dev != RT_NULL);

G
Grissiom 已提交
298 299 300 301 302 303 304 305
    if (dev->ref_count == 0)
        return -RT_ERROR;

    dev->ref_count--;

    if (dev->ref_count != 0)
        return RT_EOK;

306
    /* call device close interface */
307
    if (dev->close != RT_NULL)
308
    {
309
        result = dev->close(dev);
310 311 312 313 314 315 316
    }

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

    return result;
317
}
318
RTM_EXPORT(rt_device_close);
319 320 321 322 323 324 325 326 327 328

/**
 * 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 已提交
329 330
 *
 * @note since 0.4.0, the unit of size/pos is a block for block device.
331
 */
332 333 334 335
rt_size_t rt_device_read(rt_device_t dev,
                         rt_off_t    pos,
                         void       *buffer,
                         rt_size_t   size)
336
{
337
    RT_ASSERT(dev != RT_NULL);
338

G
Grissiom 已提交
339 340 341 342 343 344
    if (dev->ref_count == 0)
    {
        rt_set_errno(-RT_ERROR);
        return 0;
    }

345
    /* call device read interface */
346
    if (dev->read != RT_NULL)
347
    {
348
        return dev->read(dev, pos, buffer, size);
349
    }
350

351 352
    /* set error code */
    rt_set_errno(-RT_ENOSYS);
D
dzzxzz 已提交
353

354
    return 0;
355
}
356
RTM_EXPORT(rt_device_read);
357 358 359 360 361 362 363 364 365 366

/**
 * 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 已提交
367 368
 *
 * @note since 0.4.0, the unit of size/pos is a block for block device.
369
 */
370 371 372 373
rt_size_t rt_device_write(rt_device_t dev,
                          rt_off_t    pos,
                          const void *buffer,
                          rt_size_t   size)
374
{
375
    RT_ASSERT(dev != RT_NULL);
376

G
Grissiom 已提交
377 378 379 380 381 382
    if (dev->ref_count == 0)
    {
        rt_set_errno(-RT_ERROR);
        return 0;
    }

383
    /* call device write interface */
384
    if (dev->write != RT_NULL)
385
    {
386
        return dev->write(dev, pos, buffer, size);
387
    }
388

389 390
    /* set error code */
    rt_set_errno(-RT_ENOSYS);
D
dzzxzz 已提交
391

392
    return 0;
393
}
394
RTM_EXPORT(rt_device_write);
395 396 397 398 399 400 401 402 403 404

/**
 * 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
 */
B
bernard 已提交
405
rt_err_t rt_device_control(rt_device_t dev, int cmd, void *arg)
406
{
407
    RT_ASSERT(dev != RT_NULL);
408

409
    /* call device write interface */
410
    if (dev->control != RT_NULL)
411
    {
412
        return dev->control(dev, cmd, arg);
413
    }
414

B
bernard 已提交
415
    return -RT_ENOSYS;
416
}
417
RTM_EXPORT(rt_device_control);
418

B
bernard.xiong@gmail.com 已提交
419
/**
B
Bernard Xiong 已提交
420 421
 * This function will set the reception indication callback function. This callback function
 * is invoked when this device receives data.
B
bernard.xiong@gmail.com 已提交
422 423 424 425 426 427
 *
 * @param dev the pointer of device driver structure
 * @param rx_ind the indication callback function
 *
 * @return RT_EOK
 */
428 429 430
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))
431
{
432
    RT_ASSERT(dev != RT_NULL);
433

434
    dev->rx_indicate = rx_ind;
D
dzzxzz 已提交
435

436
    return RT_EOK;
437
}
438
RTM_EXPORT(rt_device_set_rx_indicate);
439

B
bernard.xiong@gmail.com 已提交
440
/**
B
Bernard Xiong 已提交
441
 * This function will set the indication callback function when device has
442
 * written data to physical hardware.
B
bernard.xiong@gmail.com 已提交
443 444 445 446 447 448
 *
 * @param dev the pointer of device driver structure
 * @param tx_done the indication callback function
 *
 * @return RT_EOK
 */
449 450 451
rt_err_t
rt_device_set_tx_complete(rt_device_t dev,
                          rt_err_t (*tx_done)(rt_device_t dev, void *buffer))
452
{
453
    RT_ASSERT(dev != RT_NULL);
454

455
    dev->tx_complete = tx_done;
D
dzzxzz 已提交
456

457
    return RT_EOK;
458
}
459
RTM_EXPORT(rt_device_set_tx_complete);
460 461

#endif