添加rtthread相关代码
This commit is contained in:
		
							
								
								
									
										135
									
								
								riscv/rtthread/components/drivers/misc/pulse_encoder.c
									
									
									
									
									
										Executable file
									
								
							
							
						
						
									
										135
									
								
								riscv/rtthread/components/drivers/misc/pulse_encoder.c
									
									
									
									
									
										Executable file
									
								
							| @@ -0,0 +1,135 @@ | ||||
| /* | ||||
|  * Copyright (c) 2006-2023, RT-Thread Development Team | ||||
|  * | ||||
|  * SPDX-License-Identifier: Apache-2.0 | ||||
|  * | ||||
|  * Change Logs: | ||||
|  * Date           Author       Notes | ||||
|  * 2019-08-08     balanceTWK   the first version | ||||
|  */ | ||||
|  | ||||
| #include <rtdevice.h> | ||||
|  | ||||
| static rt_err_t rt_pulse_encoder_init(struct rt_device *dev) | ||||
| { | ||||
|     struct rt_pulse_encoder_device *pulse_encoder; | ||||
|  | ||||
|     pulse_encoder = (struct rt_pulse_encoder_device *)dev; | ||||
|     if (pulse_encoder->ops->init) | ||||
|     { | ||||
|         return pulse_encoder->ops->init(pulse_encoder); | ||||
|     } | ||||
|     else | ||||
|     { | ||||
|         return -RT_ENOSYS; | ||||
|     } | ||||
| } | ||||
|  | ||||
| static rt_err_t rt_pulse_encoder_open(struct rt_device *dev, rt_uint16_t oflag) | ||||
| { | ||||
|     struct rt_pulse_encoder_device *pulse_encoder; | ||||
|  | ||||
|     pulse_encoder = (struct rt_pulse_encoder_device *)dev; | ||||
|     if (pulse_encoder->ops->control) | ||||
|     { | ||||
|         return pulse_encoder->ops->control(pulse_encoder, PULSE_ENCODER_CMD_ENABLE, RT_NULL); | ||||
|     } | ||||
|     else | ||||
|     { | ||||
|         return -RT_ENOSYS; | ||||
|     } | ||||
| } | ||||
|  | ||||
| static rt_err_t rt_pulse_encoder_close(struct rt_device *dev) | ||||
| { | ||||
|     struct rt_pulse_encoder_device *pulse_encoder; | ||||
|  | ||||
|     pulse_encoder = (struct rt_pulse_encoder_device *)dev; | ||||
|     if (pulse_encoder->ops->control) | ||||
|     { | ||||
|         return pulse_encoder->ops->control(pulse_encoder, PULSE_ENCODER_CMD_DISABLE, RT_NULL); | ||||
|     } | ||||
|     else | ||||
|     { | ||||
|         return -RT_ENOSYS; | ||||
|     } | ||||
| } | ||||
|  | ||||
| static rt_ssize_t rt_pulse_encoder_read(struct rt_device *dev, rt_off_t pos, void *buffer, rt_size_t size) | ||||
| { | ||||
|     struct rt_pulse_encoder_device *pulse_encoder; | ||||
|  | ||||
|     pulse_encoder = (struct rt_pulse_encoder_device *)dev; | ||||
|     if (pulse_encoder->ops->get_count) | ||||
|     { | ||||
|         *(rt_int32_t *)buffer = pulse_encoder->ops->get_count(pulse_encoder); | ||||
|     } | ||||
|     return 1; | ||||
| } | ||||
|  | ||||
| static rt_err_t rt_pulse_encoder_control(struct rt_device *dev, int cmd, void *args) | ||||
| { | ||||
|     rt_err_t result; | ||||
|     struct rt_pulse_encoder_device *pulse_encoder; | ||||
|  | ||||
|     result = RT_EOK; | ||||
|     pulse_encoder = (struct rt_pulse_encoder_device *)dev; | ||||
|     switch (cmd) | ||||
|     { | ||||
|     case PULSE_ENCODER_CMD_CLEAR_COUNT: | ||||
|         result = pulse_encoder->ops->clear_count(pulse_encoder); | ||||
|         break; | ||||
|     case PULSE_ENCODER_CMD_GET_TYPE: | ||||
|         *(enum rt_pulse_encoder_type *)args = pulse_encoder->type; | ||||
|         break; | ||||
|     case PULSE_ENCODER_CMD_ENABLE: | ||||
|     case PULSE_ENCODER_CMD_DISABLE: | ||||
|         result = pulse_encoder->ops->control(pulse_encoder, cmd, args); | ||||
|         break; | ||||
|     default: | ||||
|         result = -RT_ENOSYS; | ||||
|         break; | ||||
|     } | ||||
|  | ||||
|     return result; | ||||
| } | ||||
|  | ||||
| #ifdef RT_USING_DEVICE_OPS | ||||
| const static struct rt_device_ops pulse_encoder_ops = | ||||
| { | ||||
|     rt_pulse_encoder_init, | ||||
|     rt_pulse_encoder_open, | ||||
|     rt_pulse_encoder_close, | ||||
|     rt_pulse_encoder_read, | ||||
|     RT_NULL, | ||||
|     rt_pulse_encoder_control | ||||
| }; | ||||
| #endif | ||||
|  | ||||
| rt_err_t rt_device_pulse_encoder_register(struct rt_pulse_encoder_device *pulse_encoder, const char *name, void *user_data) | ||||
| { | ||||
|     struct rt_device *device; | ||||
|  | ||||
|     RT_ASSERT(pulse_encoder != RT_NULL); | ||||
|     RT_ASSERT(pulse_encoder->ops != RT_NULL); | ||||
|  | ||||
|     device = &(pulse_encoder->parent); | ||||
|  | ||||
|     device->type        = RT_Device_Class_Miscellaneous; | ||||
|     device->rx_indicate = RT_NULL; | ||||
|     device->tx_complete = RT_NULL; | ||||
|  | ||||
| #ifdef RT_USING_DEVICE_OPS | ||||
|     device->ops         = &pulse_encoder_ops; | ||||
| #else | ||||
|     device->init        = rt_pulse_encoder_init; | ||||
|     device->open        = rt_pulse_encoder_open; | ||||
|     device->close       = rt_pulse_encoder_close; | ||||
|     device->read        = rt_pulse_encoder_read; | ||||
|     device->write       = RT_NULL; | ||||
|     device->control     = rt_pulse_encoder_control; | ||||
| #endif | ||||
|     device->user_data   = user_data; | ||||
|  | ||||
|     return rt_device_register(device, name, RT_DEVICE_FLAG_RDONLY | RT_DEVICE_FLAG_STANDALONE); | ||||
| } | ||||
		Reference in New Issue
	
	Block a user