device.c 11.2 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 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185
#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)
{
	int size;
	rt_device_t device;

	size = RT_ALIGN(sizeof(struct rt_device), RT_ALIGN_SIZE);
	size += attach_size;

	device = (rt_device_t)rt_malloc(size);
	if (device)
	{
		rt_memset(device, 0x0, sizeof(struct rt_device));
		device->type = type;
	}

	return device;
}
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)
{
	/* unregister device firstly */
	rt_device_unregister(device);

	/* release this device object */
	rt_free(device);
}
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