device.c 8.6 KB
Newer Older
1 2 3
/*
 * File      : device.c
 * This file is part of RT-Thread RTOS
B
bernard.xiong 已提交
4
 * COPYRIGHT (C) 2006 - 2009, 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 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40
 */

#include <rtthread.h>
#include "kservice.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.
 */
rt_err_t rt_device_register(rt_device_t dev, const char* name, rt_uint16_t flags)
{
	if (dev == RT_NULL) return -RT_ERROR;

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

	return RT_EOK;
}

/**
B
bernard.xiong@gmail.com 已提交
41
 * This function removes a previously registered device driver
42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84
 *
 * @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;
}

/**
 * This function initializes all registered device driver
 *
 * @return the error code, RT_EOK on successfully.
 */
rt_err_t rt_device_init_all()
{
	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 */
	for (node = information->object_list.next; node != &(information->object_list); node = node->next)
	{
		rt_err_t (*init)(rt_device_t dev);
		device = (struct rt_device*)rt_list_entry(node, struct rt_object, list);

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

	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.
 */
rt_device_t rt_device_find(const char* name)
{
B
bernard.xiong 已提交
107 108 109 110 111 112 113 114 115 116
	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();

117
	/* try to find device object */
B
bernard.xiong 已提交
118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140
	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;
}

/**
B
bernard.xiong@gmail.com 已提交
141
 * This function will initialize the specified device
B
bernard.xiong 已提交
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
 *
 * @param dev the pointer of device driver structure
 * 
 * @return the result
 */
rt_err_t rt_device_init(rt_device_t dev)
{
	rt_err_t result;
	rt_err_t (*init)(rt_device_t dev);
	
	RT_ASSERT(dev != RT_NULL);

	/* get device init handler */
	init = dev->init;
	if (init != RT_NULL && !(dev->flag & RT_DEVICE_FLAG_ACTIVATED))
	{
		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;
		}
	}
	else result = -RT_ENOSYS;
	
	return result;
172 173 174 175 176 177
}

/**
 * This function will open a device
 *
 * @param dev the pointer of device driver structure
B
bernard.xiong@gmail.com 已提交
178
 * @param oflag the flags for device open
179 180 181 182 183 184 185 186 187 188 189 190
 *
 * @return the result
 */
rt_err_t rt_device_open(rt_device_t dev, rt_uint16_t oflag)
{
	rt_err_t result;
	rt_err_t (*open) (rt_device_t dev, rt_uint16_t oflag);

	RT_ASSERT(dev != RT_NULL);

	result = RT_EOK;

191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206
	/* if device is not initialized, initialize it. */
	if (!(dev->flag & RT_DEVICE_FLAG_ACTIVATED))
	{
		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;
		}
		else
		{
			dev->flag |= RT_DEVICE_FLAG_ACTIVATED;
		}
	}

B
bernard.xiong@gmail.com 已提交
207
	/* device is a stand alone device and opened */
208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272
	if ((dev->flag & RT_DEVICE_FLAG_STANDALONE) &&
		(dev->open_flag & RT_DEVICE_OFLAG_OPEN))
		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 */
		result = -RT_ENOSYS;
	}

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

	return result;
}

/**
 * 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 */
		result = -RT_ENOSYS;
	}

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

	return result;
}

/**
 * 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 已提交
273 274
 *
 * @note since 0.4.0, the unit of size/pos is a block for block device.
275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302
 */
rt_size_t rt_device_read (rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
{
	rt_size_t (*read)(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size);

	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);
	return 0;
}

/**
 * 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 已提交
303 304
 *
 * @note since 0.4.0, the unit of size/pos is a block for block device.
305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348
 */
rt_size_t rt_device_write(rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
{
	rt_size_t (*write)(rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size);

	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);
	return 0;
}

/**
 * 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
 */
rt_err_t rt_device_control(rt_device_t dev, rt_uint8_t cmd, void* arg)
{
	rt_err_t (*control)(rt_device_t dev, rt_uint8_t cmd, void* arg);

	RT_ASSERT(dev != RT_NULL);

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

	return -RT_ENOSYS;
}

B
bernard.xiong@gmail.com 已提交
349 350 351 352 353 354 355 356 357
/**
 * 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
 */
358 359 360 361 362 363 364 365
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))
{
	RT_ASSERT(dev != RT_NULL);

	dev->rx_indicate = rx_ind;
	return RT_EOK;
}

B
bernard.xiong@gmail.com 已提交
366 367 368 369 370 371 372 373 374
/**
 * 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
 */
375 376 377 378 379 380 381 382 383
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;
	return RT_EOK;
}

#endif