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
18
components/drivers/i2c/SConscript
Normal file
18
components/drivers/i2c/SConscript
Normal file
|
@ -0,0 +1,18 @@
|
|||
Import('RTT_ROOT')
|
||||
from building import *
|
||||
|
||||
cwd = GetCurrentDir()
|
||||
src = Split("""
|
||||
i2c_core.c
|
||||
i2c_dev.c
|
||||
""")
|
||||
|
||||
if GetDepend('RT_USING_I2C_BITOPS'):
|
||||
src = src + ['i2c-bit-ops.c']
|
||||
|
||||
# The set of source files associated with this SConscript file.
|
||||
path = [cwd + '/../include']
|
||||
|
||||
group = DefineGroup('DeviceDrivers', src, depend = ['RT_USING_I2C'], CPPPATH = path)
|
||||
|
||||
Return('group')
|
458
components/drivers/i2c/i2c-bit-ops.c
Normal file
458
components/drivers/i2c/i2c-bit-ops.c
Normal file
|
@ -0,0 +1,458 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2023, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2012-04-25 weety first version
|
||||
*/
|
||||
|
||||
#include <rtdevice.h>
|
||||
|
||||
#define DBG_TAG "I2C"
|
||||
#ifdef RT_I2C_BITOPS_DEBUG
|
||||
#define DBG_LVL DBG_LOG
|
||||
#else
|
||||
#define DBG_LVL DBG_INFO
|
||||
#endif
|
||||
#include <rtdbg.h>
|
||||
|
||||
#define SET_SDA(ops, val) ops->set_sda(ops->data, val)
|
||||
#define SET_SCL(ops, val) ops->set_scl(ops->data, val)
|
||||
#define GET_SDA(ops) ops->get_sda(ops->data)
|
||||
#define GET_SCL(ops) ops->get_scl(ops->data)
|
||||
|
||||
rt_inline void i2c_delay(struct rt_i2c_bit_ops *ops)
|
||||
{
|
||||
ops->udelay((ops->delay_us + 1) >> 1);
|
||||
}
|
||||
|
||||
rt_inline void i2c_delay2(struct rt_i2c_bit_ops *ops)
|
||||
{
|
||||
ops->udelay(ops->delay_us);
|
||||
}
|
||||
|
||||
#define SDA_L(ops) SET_SDA(ops, 0)
|
||||
#define SDA_H(ops) SET_SDA(ops, 1)
|
||||
#define SCL_L(ops) SET_SCL(ops, 0)
|
||||
|
||||
/**
|
||||
* release scl line, and wait scl line to high.
|
||||
*/
|
||||
static rt_err_t SCL_H(struct rt_i2c_bit_ops *ops)
|
||||
{
|
||||
rt_tick_t start;
|
||||
|
||||
SET_SCL(ops, 1);
|
||||
|
||||
if (!ops->get_scl)
|
||||
goto done;
|
||||
|
||||
start = rt_tick_get();
|
||||
while (!GET_SCL(ops))
|
||||
{
|
||||
if ((rt_tick_get() - start) > ops->timeout)
|
||||
return -RT_ETIMEOUT;
|
||||
i2c_delay(ops);
|
||||
}
|
||||
#ifdef RT_I2C_BITOPS_DEBUG
|
||||
if (rt_tick_get() != start)
|
||||
{
|
||||
LOG_D("wait %ld tick for SCL line to go high",
|
||||
rt_tick_get() - start);
|
||||
}
|
||||
#endif
|
||||
|
||||
done:
|
||||
i2c_delay(ops);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static void i2c_start(struct rt_i2c_bit_ops *ops)
|
||||
{
|
||||
#ifdef RT_I2C_BITOPS_DEBUG
|
||||
if (ops->get_scl && !GET_SCL(ops))
|
||||
{
|
||||
LOG_E("I2C bus error, SCL line low");
|
||||
}
|
||||
if (ops->get_sda && !GET_SDA(ops))
|
||||
{
|
||||
LOG_E("I2C bus error, SDA line low");
|
||||
}
|
||||
#endif
|
||||
SDA_L(ops);
|
||||
i2c_delay(ops);
|
||||
SCL_L(ops);
|
||||
}
|
||||
|
||||
static void i2c_restart(struct rt_i2c_bit_ops *ops)
|
||||
{
|
||||
SDA_H(ops);
|
||||
SCL_H(ops);
|
||||
i2c_delay(ops);
|
||||
SDA_L(ops);
|
||||
i2c_delay(ops);
|
||||
SCL_L(ops);
|
||||
}
|
||||
|
||||
static void i2c_stop(struct rt_i2c_bit_ops *ops)
|
||||
{
|
||||
SDA_L(ops);
|
||||
i2c_delay(ops);
|
||||
SCL_H(ops);
|
||||
i2c_delay(ops);
|
||||
SDA_H(ops);
|
||||
i2c_delay2(ops);
|
||||
}
|
||||
|
||||
rt_inline rt_bool_t i2c_waitack(struct rt_i2c_bit_ops *ops)
|
||||
{
|
||||
rt_bool_t ack;
|
||||
|
||||
SDA_H(ops);
|
||||
i2c_delay(ops);
|
||||
|
||||
if (SCL_H(ops) < 0)
|
||||
{
|
||||
LOG_W("wait ack timeout");
|
||||
|
||||
return -RT_ETIMEOUT;
|
||||
}
|
||||
|
||||
ack = !GET_SDA(ops); /* ACK : SDA pin is pulled low */
|
||||
LOG_D("%s", ack ? "ACK" : "NACK");
|
||||
|
||||
SCL_L(ops);
|
||||
|
||||
return ack;
|
||||
}
|
||||
|
||||
static rt_int32_t i2c_writeb(struct rt_i2c_bus_device *bus, rt_uint8_t data)
|
||||
{
|
||||
rt_int32_t i;
|
||||
rt_uint8_t bit;
|
||||
|
||||
struct rt_i2c_bit_ops *ops = (struct rt_i2c_bit_ops *)bus->priv;
|
||||
|
||||
for (i = 7; i >= 0; i--)
|
||||
{
|
||||
SCL_L(ops);
|
||||
bit = (data >> i) & 1;
|
||||
SET_SDA(ops, bit);
|
||||
i2c_delay(ops);
|
||||
if (SCL_H(ops) < 0)
|
||||
{
|
||||
LOG_D("i2c_writeb: 0x%02x, "
|
||||
"wait scl pin high timeout at bit %d",
|
||||
data, i);
|
||||
|
||||
return -RT_ETIMEOUT;
|
||||
}
|
||||
}
|
||||
SCL_L(ops);
|
||||
i2c_delay(ops);
|
||||
|
||||
return i2c_waitack(ops);
|
||||
}
|
||||
|
||||
static rt_int32_t i2c_readb(struct rt_i2c_bus_device *bus)
|
||||
{
|
||||
rt_uint8_t i;
|
||||
rt_uint8_t data = 0;
|
||||
struct rt_i2c_bit_ops *ops = (struct rt_i2c_bit_ops *)bus->priv;
|
||||
|
||||
SDA_H(ops);
|
||||
i2c_delay(ops);
|
||||
for (i = 0; i < 8; i++)
|
||||
{
|
||||
data <<= 1;
|
||||
|
||||
if (SCL_H(ops) < 0)
|
||||
{
|
||||
LOG_D("i2c_readb: wait scl pin high "
|
||||
"timeout at bit %d", 7 - i);
|
||||
|
||||
return -RT_ETIMEOUT;
|
||||
}
|
||||
|
||||
if (GET_SDA(ops))
|
||||
data |= 1;
|
||||
SCL_L(ops);
|
||||
i2c_delay2(ops);
|
||||
}
|
||||
|
||||
return data;
|
||||
}
|
||||
|
||||
static rt_ssize_t i2c_send_bytes(struct rt_i2c_bus_device *bus,
|
||||
struct rt_i2c_msg *msg)
|
||||
{
|
||||
rt_int32_t ret;
|
||||
rt_size_t bytes = 0;
|
||||
const rt_uint8_t *ptr = msg->buf;
|
||||
rt_int32_t count = msg->len;
|
||||
rt_uint16_t ignore_nack = msg->flags & RT_I2C_IGNORE_NACK;
|
||||
|
||||
while (count > 0)
|
||||
{
|
||||
ret = i2c_writeb(bus, *ptr);
|
||||
|
||||
if ((ret > 0) || (ignore_nack && (ret == 0)))
|
||||
{
|
||||
count --;
|
||||
ptr ++;
|
||||
bytes ++;
|
||||
}
|
||||
else if (ret == 0)
|
||||
{
|
||||
LOG_D("send bytes: NACK.");
|
||||
|
||||
return 0;
|
||||
}
|
||||
else
|
||||
{
|
||||
LOG_E("send bytes: error %d", ret);
|
||||
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
return bytes;
|
||||
}
|
||||
|
||||
static rt_err_t i2c_send_ack_or_nack(struct rt_i2c_bus_device *bus, int ack)
|
||||
{
|
||||
struct rt_i2c_bit_ops *ops = (struct rt_i2c_bit_ops *)bus->priv;
|
||||
|
||||
if (ack)
|
||||
SET_SDA(ops, 0);
|
||||
i2c_delay(ops);
|
||||
if (SCL_H(ops) < 0)
|
||||
{
|
||||
LOG_E("ACK or NACK timeout.");
|
||||
|
||||
return -RT_ETIMEOUT;
|
||||
}
|
||||
SCL_L(ops);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_ssize_t i2c_recv_bytes(struct rt_i2c_bus_device *bus,
|
||||
struct rt_i2c_msg *msg)
|
||||
{
|
||||
rt_int32_t val;
|
||||
rt_int32_t bytes = 0; /* actual bytes */
|
||||
rt_uint8_t *ptr = msg->buf;
|
||||
rt_int32_t count = msg->len;
|
||||
const rt_uint32_t flags = msg->flags;
|
||||
|
||||
while (count > 0)
|
||||
{
|
||||
val = i2c_readb(bus);
|
||||
if (val >= 0)
|
||||
{
|
||||
*ptr = val;
|
||||
bytes ++;
|
||||
}
|
||||
else
|
||||
{
|
||||
break;
|
||||
}
|
||||
|
||||
ptr ++;
|
||||
count --;
|
||||
|
||||
LOG_D("recieve bytes: 0x%02x, %s",
|
||||
val, (flags & RT_I2C_NO_READ_ACK) ?
|
||||
"(No ACK/NACK)" : (count ? "ACK" : "NACK"));
|
||||
|
||||
if (!(flags & RT_I2C_NO_READ_ACK))
|
||||
{
|
||||
val = i2c_send_ack_or_nack(bus, count);
|
||||
if (val < 0)
|
||||
return val;
|
||||
}
|
||||
}
|
||||
|
||||
return bytes;
|
||||
}
|
||||
|
||||
static rt_int32_t i2c_send_address(struct rt_i2c_bus_device *bus,
|
||||
rt_uint8_t addr,
|
||||
rt_int32_t retries)
|
||||
{
|
||||
struct rt_i2c_bit_ops *ops = (struct rt_i2c_bit_ops *)bus->priv;
|
||||
rt_int32_t i;
|
||||
rt_err_t ret = 0;
|
||||
|
||||
for (i = 0; i <= retries; i++)
|
||||
{
|
||||
ret = i2c_writeb(bus, addr);
|
||||
if (ret == 1 || i == retries)
|
||||
break;
|
||||
LOG_D("send stop condition");
|
||||
i2c_stop(ops);
|
||||
i2c_delay2(ops);
|
||||
LOG_D("send start condition");
|
||||
i2c_start(ops);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static rt_err_t i2c_bit_send_address(struct rt_i2c_bus_device *bus,
|
||||
struct rt_i2c_msg *msg)
|
||||
{
|
||||
rt_uint16_t flags = msg->flags;
|
||||
rt_uint16_t ignore_nack = msg->flags & RT_I2C_IGNORE_NACK;
|
||||
struct rt_i2c_bit_ops *ops = (struct rt_i2c_bit_ops *)bus->priv;
|
||||
|
||||
rt_uint8_t addr1, addr2;
|
||||
rt_int32_t retries;
|
||||
rt_err_t ret;
|
||||
|
||||
retries = ignore_nack ? 0 : bus->retries;
|
||||
|
||||
if (flags & RT_I2C_ADDR_10BIT)
|
||||
{
|
||||
addr1 = 0xf0 | ((msg->addr >> 7) & 0x06);
|
||||
addr2 = msg->addr & 0xff;
|
||||
|
||||
LOG_D("addr1: %d, addr2: %d", addr1, addr2);
|
||||
|
||||
ret = i2c_send_address(bus, addr1, retries);
|
||||
if ((ret != 1) && !ignore_nack)
|
||||
{
|
||||
LOG_W("NACK: sending first addr");
|
||||
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
ret = i2c_writeb(bus, addr2);
|
||||
if ((ret != 1) && !ignore_nack)
|
||||
{
|
||||
LOG_W("NACK: sending second addr");
|
||||
|
||||
return -RT_EIO;
|
||||
}
|
||||
if (flags & RT_I2C_RD)
|
||||
{
|
||||
LOG_D("send repeated start condition");
|
||||
i2c_restart(ops);
|
||||
addr1 |= 0x01;
|
||||
ret = i2c_send_address(bus, addr1, retries);
|
||||
if ((ret != 1) && !ignore_nack)
|
||||
{
|
||||
LOG_E("NACK: sending repeated addr");
|
||||
|
||||
return -RT_EIO;
|
||||
}
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
/* 7-bit addr */
|
||||
addr1 = msg->addr << 1;
|
||||
if (flags & RT_I2C_RD)
|
||||
addr1 |= 1;
|
||||
ret = i2c_send_address(bus, addr1, retries);
|
||||
if ((ret != 1) && !ignore_nack)
|
||||
return -RT_EIO;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_ssize_t i2c_bit_xfer(struct rt_i2c_bus_device *bus,
|
||||
struct rt_i2c_msg msgs[],
|
||||
rt_uint32_t num)
|
||||
{
|
||||
struct rt_i2c_msg *msg;
|
||||
struct rt_i2c_bit_ops *ops = (struct rt_i2c_bit_ops *)bus->priv;
|
||||
rt_int32_t ret;
|
||||
rt_uint32_t i;
|
||||
rt_uint16_t ignore_nack;
|
||||
|
||||
if (num == 0) return 0;
|
||||
|
||||
for (i = 0; i < num; i++)
|
||||
{
|
||||
msg = &msgs[i];
|
||||
ignore_nack = msg->flags & RT_I2C_IGNORE_NACK;
|
||||
if (!(msg->flags & RT_I2C_NO_START))
|
||||
{
|
||||
if (i)
|
||||
{
|
||||
i2c_restart(ops);
|
||||
}
|
||||
else
|
||||
{
|
||||
LOG_D("send start condition");
|
||||
i2c_start(ops);
|
||||
}
|
||||
ret = i2c_bit_send_address(bus, msg);
|
||||
if ((ret != RT_EOK) && !ignore_nack)
|
||||
{
|
||||
LOG_D("receive NACK from device addr 0x%02x msg %d",
|
||||
msgs[i].addr, i);
|
||||
goto out;
|
||||
}
|
||||
}
|
||||
if (msg->flags & RT_I2C_RD)
|
||||
{
|
||||
ret = i2c_recv_bytes(bus, msg);
|
||||
if (ret >= 1)
|
||||
{
|
||||
LOG_D("read %d byte%s", ret, ret == 1 ? "" : "s");
|
||||
}
|
||||
if (ret < msg->len)
|
||||
{
|
||||
if (ret >= 0)
|
||||
ret = -RT_EIO;
|
||||
goto out;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
ret = i2c_send_bytes(bus, msg);
|
||||
if (ret >= 1)
|
||||
{
|
||||
LOG_D("write %d byte%s", ret, ret == 1 ? "" : "s");
|
||||
}
|
||||
if (ret < msg->len)
|
||||
{
|
||||
if (ret >= 0)
|
||||
ret = -RT_ERROR;
|
||||
goto out;
|
||||
}
|
||||
}
|
||||
}
|
||||
ret = i;
|
||||
|
||||
out:
|
||||
if (!(msg->flags & RT_I2C_NO_STOP))
|
||||
{
|
||||
LOG_D("send stop condition");
|
||||
i2c_stop(ops);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static const struct rt_i2c_bus_device_ops i2c_bit_bus_ops =
|
||||
{
|
||||
i2c_bit_xfer,
|
||||
RT_NULL,
|
||||
RT_NULL
|
||||
};
|
||||
|
||||
rt_err_t rt_i2c_bit_add_bus(struct rt_i2c_bus_device *bus,
|
||||
const char *bus_name)
|
||||
{
|
||||
bus->ops = &i2c_bit_bus_ops;
|
||||
|
||||
return rt_i2c_bus_device_register(bus, bus_name);
|
||||
}
|
146
components/drivers/i2c/i2c_core.c
Normal file
146
components/drivers/i2c/i2c_core.c
Normal file
|
@ -0,0 +1,146 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2023, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2012-04-25 weety first version
|
||||
* 2021-04-20 RiceChen added support for bus control api
|
||||
*/
|
||||
|
||||
#include <rtdevice.h>
|
||||
|
||||
#define DBG_TAG "I2C"
|
||||
#ifdef RT_I2C_DEBUG
|
||||
#define DBG_LVL DBG_LOG
|
||||
#else
|
||||
#define DBG_LVL DBG_INFO
|
||||
#endif
|
||||
#include <rtdbg.h>
|
||||
|
||||
rt_err_t rt_i2c_bus_device_register(struct rt_i2c_bus_device *bus,
|
||||
const char *bus_name)
|
||||
{
|
||||
rt_err_t res = RT_EOK;
|
||||
|
||||
rt_mutex_init(&bus->lock, "i2c_bus_lock", RT_IPC_FLAG_PRIO);
|
||||
|
||||
if (bus->timeout == 0) bus->timeout = RT_TICK_PER_SECOND;
|
||||
|
||||
res = rt_i2c_bus_device_device_init(bus, bus_name);
|
||||
|
||||
LOG_I("I2C bus [%s] registered", bus_name);
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
struct rt_i2c_bus_device *rt_i2c_bus_device_find(const char *bus_name)
|
||||
{
|
||||
struct rt_i2c_bus_device *bus;
|
||||
rt_device_t dev = rt_device_find(bus_name);
|
||||
if (dev == RT_NULL || dev->type != RT_Device_Class_I2CBUS)
|
||||
{
|
||||
LOG_E("I2C bus %s not exist", bus_name);
|
||||
|
||||
return RT_NULL;
|
||||
}
|
||||
|
||||
bus = (struct rt_i2c_bus_device *)dev->user_data;
|
||||
|
||||
return bus;
|
||||
}
|
||||
|
||||
rt_ssize_t rt_i2c_transfer(struct rt_i2c_bus_device *bus,
|
||||
struct rt_i2c_msg msgs[],
|
||||
rt_uint32_t num)
|
||||
{
|
||||
rt_ssize_t ret;
|
||||
rt_err_t err;
|
||||
|
||||
if (bus->ops->master_xfer)
|
||||
{
|
||||
#ifdef RT_I2C_DEBUG
|
||||
for (ret = 0; ret < num; ret++)
|
||||
{
|
||||
LOG_D("msgs[%d] %c, addr=0x%02x, len=%d", ret,
|
||||
(msgs[ret].flags & RT_I2C_RD) ? 'R' : 'W',
|
||||
msgs[ret].addr, msgs[ret].len);
|
||||
}
|
||||
#endif
|
||||
err = rt_mutex_take(&bus->lock, RT_WAITING_FOREVER);
|
||||
if (err != RT_EOK)
|
||||
{
|
||||
return (rt_ssize_t)err;
|
||||
}
|
||||
ret = bus->ops->master_xfer(bus, msgs, num);
|
||||
err = rt_mutex_release(&bus->lock);
|
||||
if (err != RT_EOK)
|
||||
{
|
||||
return (rt_ssize_t)err;
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
else
|
||||
{
|
||||
LOG_E("I2C bus operation not supported");
|
||||
return -RT_EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
rt_err_t rt_i2c_control(struct rt_i2c_bus_device *bus,
|
||||
rt_uint32_t cmd,
|
||||
rt_uint32_t arg)
|
||||
{
|
||||
rt_err_t ret;
|
||||
|
||||
if(bus->ops->i2c_bus_control)
|
||||
{
|
||||
ret = bus->ops->i2c_bus_control(bus, cmd, arg);
|
||||
return ret;
|
||||
}
|
||||
else
|
||||
{
|
||||
LOG_E("I2C bus operation not supported");
|
||||
return -RT_EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
rt_ssize_t rt_i2c_master_send(struct rt_i2c_bus_device *bus,
|
||||
rt_uint16_t addr,
|
||||
rt_uint16_t flags,
|
||||
const rt_uint8_t *buf,
|
||||
rt_uint32_t count)
|
||||
{
|
||||
rt_ssize_t ret;
|
||||
struct rt_i2c_msg msg;
|
||||
|
||||
msg.addr = addr;
|
||||
msg.flags = flags;
|
||||
msg.len = count;
|
||||
msg.buf = (rt_uint8_t *)buf;
|
||||
|
||||
ret = rt_i2c_transfer(bus, &msg, 1);
|
||||
|
||||
return (ret == 1) ? count : ret;
|
||||
}
|
||||
|
||||
rt_ssize_t rt_i2c_master_recv(struct rt_i2c_bus_device *bus,
|
||||
rt_uint16_t addr,
|
||||
rt_uint16_t flags,
|
||||
rt_uint8_t *buf,
|
||||
rt_uint32_t count)
|
||||
{
|
||||
rt_ssize_t ret;
|
||||
struct rt_i2c_msg msg;
|
||||
RT_ASSERT(bus != RT_NULL);
|
||||
|
||||
msg.addr = addr;
|
||||
msg.flags = flags | RT_I2C_RD;
|
||||
msg.len = count;
|
||||
msg.buf = buf;
|
||||
|
||||
ret = rt_i2c_transfer(bus, &msg, 1);
|
||||
|
||||
return (ret == 1) ? count : ret;
|
||||
}
|
146
components/drivers/i2c/i2c_dev.c
Normal file
146
components/drivers/i2c/i2c_dev.c
Normal file
|
@ -0,0 +1,146 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2023, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2012-04-25 weety first version
|
||||
* 2014-08-03 bernard fix some compiling warning
|
||||
* 2021-04-20 RiceChen added support for bus clock control
|
||||
*/
|
||||
|
||||
#include <rtdevice.h>
|
||||
|
||||
#define DBG_TAG "I2C"
|
||||
#ifdef RT_I2C_DEBUG
|
||||
#define DBG_LVL DBG_LOG
|
||||
#else
|
||||
#define DBG_LVL DBG_INFO
|
||||
#endif
|
||||
#include <rtdbg.h>
|
||||
|
||||
static rt_ssize_t i2c_bus_device_read(rt_device_t dev,
|
||||
rt_off_t pos,
|
||||
void *buffer,
|
||||
rt_size_t count)
|
||||
{
|
||||
rt_uint16_t addr;
|
||||
rt_uint16_t flags;
|
||||
struct rt_i2c_bus_device *bus = (struct rt_i2c_bus_device *)dev->user_data;
|
||||
|
||||
RT_ASSERT(bus != RT_NULL);
|
||||
RT_ASSERT(buffer != RT_NULL);
|
||||
|
||||
LOG_D("I2C bus dev [%s] reading %u bytes.", dev->parent.name, count);
|
||||
|
||||
addr = pos & 0xffff;
|
||||
flags = (pos >> 16) & 0xffff;
|
||||
|
||||
return rt_i2c_master_recv(bus, addr, flags, (rt_uint8_t *)buffer, count);
|
||||
}
|
||||
|
||||
static rt_ssize_t i2c_bus_device_write(rt_device_t dev,
|
||||
rt_off_t pos,
|
||||
const void *buffer,
|
||||
rt_size_t count)
|
||||
{
|
||||
rt_uint16_t addr;
|
||||
rt_uint16_t flags;
|
||||
struct rt_i2c_bus_device *bus = (struct rt_i2c_bus_device *)dev->user_data;
|
||||
|
||||
RT_ASSERT(bus != RT_NULL);
|
||||
RT_ASSERT(buffer != RT_NULL);
|
||||
|
||||
LOG_D("I2C bus dev [%s] writing %u bytes.", dev->parent.name, count);
|
||||
|
||||
addr = pos & 0xffff;
|
||||
flags = (pos >> 16) & 0xffff;
|
||||
|
||||
return rt_i2c_master_send(bus, addr, flags, (const rt_uint8_t *)buffer, count);
|
||||
}
|
||||
|
||||
static rt_err_t i2c_bus_device_control(rt_device_t dev,
|
||||
int cmd,
|
||||
void *args)
|
||||
{
|
||||
rt_err_t ret;
|
||||
struct rt_i2c_priv_data *priv_data;
|
||||
struct rt_i2c_bus_device *bus = (struct rt_i2c_bus_device *)dev->user_data;
|
||||
rt_uint32_t bus_clock;
|
||||
|
||||
RT_ASSERT(bus != RT_NULL);
|
||||
|
||||
switch (cmd)
|
||||
{
|
||||
/* set 10-bit addr mode */
|
||||
case RT_I2C_DEV_CTRL_10BIT:
|
||||
bus->flags |= RT_I2C_ADDR_10BIT;
|
||||
break;
|
||||
case RT_I2C_DEV_CTRL_TIMEOUT:
|
||||
bus->timeout = *(rt_uint32_t *)args;
|
||||
break;
|
||||
case RT_I2C_DEV_CTRL_RW:
|
||||
priv_data = (struct rt_i2c_priv_data *)args;
|
||||
ret = rt_i2c_transfer(bus, priv_data->msgs, priv_data->number);
|
||||
if (ret < 0)
|
||||
{
|
||||
return -RT_EIO;
|
||||
}
|
||||
break;
|
||||
case RT_I2C_DEV_CTRL_CLK:
|
||||
bus_clock = *(rt_uint32_t *)args;
|
||||
ret = rt_i2c_control(bus, cmd, bus_clock);
|
||||
if (ret < 0)
|
||||
{
|
||||
return -RT_EIO;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
#ifdef RT_USING_DEVICE_OPS
|
||||
const static struct rt_device_ops i2c_ops =
|
||||
{
|
||||
RT_NULL,
|
||||
RT_NULL,
|
||||
RT_NULL,
|
||||
i2c_bus_device_read,
|
||||
i2c_bus_device_write,
|
||||
i2c_bus_device_control
|
||||
};
|
||||
#endif
|
||||
|
||||
rt_err_t rt_i2c_bus_device_device_init(struct rt_i2c_bus_device *bus,
|
||||
const char *name)
|
||||
{
|
||||
struct rt_device *device;
|
||||
RT_ASSERT(bus != RT_NULL);
|
||||
|
||||
device = &bus->parent;
|
||||
|
||||
device->user_data = bus;
|
||||
|
||||
/* set device type */
|
||||
device->type = RT_Device_Class_I2CBUS;
|
||||
/* initialize device interface */
|
||||
#ifdef RT_USING_DEVICE_OPS
|
||||
device->ops = &i2c_ops;
|
||||
#else
|
||||
device->init = RT_NULL;
|
||||
device->open = RT_NULL;
|
||||
device->close = RT_NULL;
|
||||
device->read = i2c_bus_device_read;
|
||||
device->write = i2c_bus_device_write;
|
||||
device->control = i2c_bus_device_control;
|
||||
#endif
|
||||
|
||||
/* register to device manager */
|
||||
rt_device_register(device, name, RT_DEVICE_FLAG_RDWR);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
Loading…
Add table
Add a link
Reference in a new issue