device.c 9.2 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 6 7
 *
 * The license and distribution terms for this file may be
 * found in the file LICENSE in this distribution or at
B
bernard.xiong 已提交
8
 * http://www.rt-thread.org/license/LICENSE
9 10 11 12
 *
 * Change Logs:
 * Date           Author       Notes
 * 2007-01-21     Bernard      the first version
B
bernard.xiong 已提交
13
 * 2010-05-04     Bernard      add rt_device_init implementation
14 15
 * 2012-10-20     Bernard      add device check in register function, 
 *                             provided by Rob <rdent@iinet.net.au>
16 17 18 19 20 21 22 23 24 25 26 27 28 29 30
 */

#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.
 */
D
dzzxzz 已提交
31
rt_err_t rt_device_register(rt_device_t dev, const char *name, rt_uint16_t flags)
32
{
D
dzzxzz 已提交
33 34
	if (dev == RT_NULL)
		return -RT_ERROR;
35

36 37 38
	if (rt_device_find(name) != RT_NULL) 
		return -RT_ERROR;

39 40 41 42 43
	rt_object_init(&(dev->parent), RT_Object_Class_Device, name);
	dev->flag = flags;

	return RT_EOK;
}
44
RTM_EXPORT(rt_device_register);
45 46

/**
B
bernard.xiong@gmail.com 已提交
47
 * This function removes a previously registered device driver
48 49 50 51 52 53 54 55 56 57 58 59 60
 *
 * @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)
{
	RT_ASSERT(dev != RT_NULL);

	rt_object_detach(&(dev->parent));

	return RT_EOK;
}
61
RTM_EXPORT(rt_device_unregister);
62 63 64 65 66 67

/**
 * This function initializes all registered device driver
 *
 * @return the error code, RT_EOK on successfully.
 */
D
dzzxzz 已提交
68
rt_err_t rt_device_init_all(void)
69
{
D
dzzxzz 已提交
70 71
	struct rt_device *device;
	struct rt_list_node *node;
72 73 74 75 76 77 78 79 80 81 82
	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 */
	for (node = information->object_list.next; node != &(information->object_list); node = node->next)
	{
		rt_err_t (*init)(rt_device_t dev);
D
dzzxzz 已提交
83
		device = (struct rt_device *)rt_list_entry(node, struct rt_object, list);
84 85 86 87 88 89 90 91

		/* get device init handler */
		init = device->init;
		if (init != RT_NULL && !(device->flag & RT_DEVICE_FLAG_ACTIVATED))
		{
			result = init(device);
			if (result != RT_EOK)
			{
92
				rt_kprintf("To initialize device:%s failed. The error code is %d\n",
B
bernard.xiong 已提交
93
					device->parent.name, result);
94 95 96 97
			}
			else
			{
				device->flag |= RT_DEVICE_FLAG_ACTIVATED;
98 99 100 101 102 103 104 105 106 107 108 109 110 111
			}
		}
	}

	return RT_EOK;
}

/**
 * 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 已提交
112
rt_device_t rt_device_find(const char *name)
113
{
D
dzzxzz 已提交
114 115
	struct rt_object *object;
	struct rt_list_node *node;
B
bernard.xiong 已提交
116 117 118 119 120 121 122 123
	struct rt_object_information *information;

	extern struct rt_object_information rt_object_container[];

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

124
	/* try to find device object */
B
bernard.xiong 已提交
125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145
	information = &rt_object_container[RT_Object_Class_Device];
	for (node = information->object_list.next; node != &(information->object_list); node = node->next)
	{
		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;
}
146
RTM_EXPORT(rt_device_find);
B
bernard.xiong 已提交
147 148

/**
B
bernard.xiong@gmail.com 已提交
149
 * This function will initialize the specified device
B
bernard.xiong 已提交
150 151 152 153 154 155 156
 *
 * @param dev the pointer of device driver structure
 * 
 * @return the result
 */
rt_err_t rt_device_init(rt_device_t dev)
{
wuyangyong's avatar
wuyangyong 已提交
157
	rt_err_t result = RT_EOK;
B
bernard.xiong 已提交
158 159 160 161 162 163
	rt_err_t (*init)(rt_device_t dev);
	
	RT_ASSERT(dev != RT_NULL);

	/* get device init handler */
	init = dev->init;
164 165
	if (init != RT_NULL)
	{
D
dzzxzz 已提交
166
		if (!(dev->flag & RT_DEVICE_FLAG_ACTIVATED))
167 168 169 170 171 172 173 174 175 176 177 178 179
		{
			result = init(dev);
			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;
			}
		}
	}
D
dzzxzz 已提交
180 181
	else
		result = -RT_ENOSYS;
D
dzzxzz 已提交
182

B
bernard.xiong 已提交
183
	return result;
184 185 186 187 188 189
}

/**
 * This function will open a device
 *
 * @param dev the pointer of device driver structure
B
bernard.xiong@gmail.com 已提交
190
 * @param oflag the flags for device open
191 192 193 194 195 196
 *
 * @return the result
 */
rt_err_t rt_device_open(rt_device_t dev, rt_uint16_t oflag)
{
	rt_err_t result;
D
dzzxzz 已提交
197
	rt_err_t (*open)(rt_device_t dev, rt_uint16_t oflag);
198 199 200 201 202

	RT_ASSERT(dev != RT_NULL);

	result = RT_EOK;

203 204 205
	/* if device is not initialized, initialize it. */
	if (!(dev->flag & RT_DEVICE_FLAG_ACTIVATED))
	{
206
		if (dev->init != RT_NULL )
207
		{
208 209 210 211 212
			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);
D
dzzxzz 已提交
213

214 215
				return result;
			}
216
		}
217 218

		dev->flag |= RT_DEVICE_FLAG_ACTIVATED;
219 220
	}

B
bernard.xiong@gmail.com 已提交
221
	/* device is a stand alone device and opened */
D
dzzxzz 已提交
222
	if ((dev->flag & RT_DEVICE_FLAG_STANDALONE) && (dev->open_flag & RT_DEVICE_OFLAG_OPEN))
223 224 225 226 227 228 229 230 231 232 233
		return -RT_EBUSY;

	/* call device open interface */
	open = dev->open;
	if (open != RT_NULL)
	{
		result = open(dev, oflag);
	}
	else
	{
		/* no this interface in device driver */
234
		/* result = -RT_ENOSYS; not set errno */
235 236 237 238 239 240 241 242
	}

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

	return result;
}
243
RTM_EXPORT(rt_device_open);
244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267

/**
 * 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)
{
	rt_err_t result;
	rt_err_t (*close)(rt_device_t dev);

	RT_ASSERT(dev != RT_NULL);

	/* call device close interface */
	close = dev->close;
	if (close != RT_NULL)
	{
		result = close(dev);
	}
	else
	{
		/* no this interface in device driver */
268
		/* result = -RT_ENOSYS; not set errno */
269 270 271 272 273 274 275 276
	}

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

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

/**
 * 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 已提交
288 289
 *
 * @note since 0.4.0, the unit of size/pos is a block for block device.
290
 */
D
dzzxzz 已提交
291
rt_size_t rt_device_read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size)
292
{
D
dzzxzz 已提交
293
	rt_size_t (*read)(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size);
294 295 296 297 298 299 300 301 302 303 304 305

	RT_ASSERT(dev != RT_NULL);

	/* call device read interface */
	read = dev->read;
	if (read != RT_NULL)
	{
		return read(dev, pos, buffer, size);
	}

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

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

/**
 * 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 已提交
320 321
 *
 * @note since 0.4.0, the unit of size/pos is a block for block device.
322
 */
D
dzzxzz 已提交
323
rt_size_t rt_device_write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size)
324
{
D
dzzxzz 已提交
325
	rt_size_t (*write)(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size);
326 327 328 329 330 331 332 333 334 335 336 337

	RT_ASSERT(dev != RT_NULL);

	/* call device write interface */
	write = dev->write;
	if (write != RT_NULL)
	{
		return write(dev, pos, buffer, size);
	}

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

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

/**
 * 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 已提交
352
rt_err_t rt_device_control(rt_device_t dev, rt_uint8_t cmd, void *arg)
353
{
D
dzzxzz 已提交
354
	rt_err_t (*control)(rt_device_t dev, rt_uint8_t cmd, void *arg);
355 356 357 358 359 360 361 362 363 364 365 366

	RT_ASSERT(dev != RT_NULL);

	/* call device write interface */
	control = dev->control;
	if (control != RT_NULL)
	{
		return control(dev, cmd, arg);
	}

	return -RT_ENOSYS;
}
367
RTM_EXPORT(rt_device_control);
368

B
bernard.xiong@gmail.com 已提交
369 370 371 372 373 374 375 376 377
/**
 * 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
 */
D
dzzxzz 已提交
378
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))
379 380 381 382
{
	RT_ASSERT(dev != RT_NULL);

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

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

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

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

403 404
	return RT_EOK;
}
405
RTM_EXPORT(rt_device_set_tx_complete);
406 407

#endif