import RT-Thread@9217865c without bsp, libcpu and components/net
This commit is contained in:
commit
e2376a3709
1414 changed files with 390370 additions and 0 deletions
135
components/drivers/misc/pulse_encoder.c
Normal file
135
components/drivers/misc/pulse_encoder.c
Normal 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);
|
||||
}
|
Loading…
Add table
Add a link
Reference in a new issue