mirror of
https://github.com/RT-Thread/rt-thread.git
synced 2025-02-21 00:27:19 +08:00
fixed the coding style in the components/drivers
git-svn-id: https://rt-thread.googlecode.com/svn/trunk@2431 bbd45198-f89e-11dd-88c7-29a3b14d5316
This commit is contained in:
parent
871951930b
commit
68b7e7c481
@ -1,444 +1,450 @@
|
|||||||
/*
|
/*
|
||||||
* File : i2c-bit-ops.c
|
* File : i2c-bit-ops.c
|
||||||
* This file is part of RT-Thread RTOS
|
* This file is part of RT-Thread RTOS
|
||||||
* COPYRIGHT (C) 2006, RT-Thread Development Team
|
* COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
||||||
*
|
*
|
||||||
* The license and distribution terms for this file may be
|
* The license and distribution terms for this file may be
|
||||||
* found in the file LICENSE in this distribution or at
|
* found in the file LICENSE in this distribution or at
|
||||||
* http://www.rt-thread.org/license/LICENSE
|
* http://www.rt-thread.org/license/LICENSE
|
||||||
*
|
*
|
||||||
* Change Logs:
|
* Change Logs:
|
||||||
* Date Author Notes
|
* Date Author Notes
|
||||||
* 2012-04-25 weety first version
|
* 2012-04-25 weety first version
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <rtdevice.h>
|
#include <rtdevice.h>
|
||||||
|
|
||||||
#ifdef RT_I2C_BIT_DEBUG
|
#ifdef RT_I2C_BIT_DEBUG
|
||||||
#define bit_dbg(fmt, ...) rt_kprintf(fmt, ##__VA_ARGS__)
|
#define bit_dbg(fmt, ...) rt_kprintf(fmt, ##__VA_ARGS__)
|
||||||
#else
|
#else
|
||||||
#define bit_dbg(fmt, ...)
|
#define bit_dbg(fmt, ...)
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#define SET_SDA(ops, val) ops->set_sda(ops->data, val)
|
||||||
#define SET_SDA(ops, val) ops->set_sda(ops->data, val)
|
#define SET_SCL(ops, val) ops->set_scl(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_SDA(ops) ops->get_sda(ops->data)
|
#define GET_SCL(ops) ops->get_scl(ops->data)
|
||||||
#define GET_SCL(ops) ops->get_scl(ops->data)
|
|
||||||
|
rt_inline void i2c_delay(struct rt_i2c_bit_ops *ops)
|
||||||
rt_inline void i2c_delay(struct rt_i2c_bit_ops *ops)
|
{
|
||||||
{
|
ops->udelay((ops->delay_us + 1) >> 1);
|
||||||
ops->udelay((ops->delay_us + 1) >> 1);
|
}
|
||||||
}
|
|
||||||
|
rt_inline void i2c_delay2(struct rt_i2c_bit_ops *ops)
|
||||||
rt_inline void i2c_delay2(struct rt_i2c_bit_ops *ops)
|
{
|
||||||
{
|
ops->udelay(ops->delay_us);
|
||||||
ops->udelay(ops->delay_us);
|
}
|
||||||
}
|
|
||||||
|
#define SDA_L(ops) SET_SDA(ops, 0)
|
||||||
#define SDA_L(ops) SET_SDA(ops, 0)
|
#define SDA_H(ops) SET_SDA(ops, 1)
|
||||||
#define SDA_H(ops) SET_SDA(ops, 1)
|
#define SCL_L(ops) SET_SCL(ops, 0)
|
||||||
#define SCL_L(ops) SET_SCL(ops, 0)
|
|
||||||
|
/**
|
||||||
/*
|
* release scl line, and wait scl line to high.
|
||||||
* release scl line, and wait scl line to high.
|
*/
|
||||||
*/
|
static rt_err_t SCL_H(struct rt_i2c_bit_ops *ops)
|
||||||
static rt_err_t SCL_H(struct rt_i2c_bit_ops *ops)
|
{
|
||||||
{
|
rt_tick_t start;
|
||||||
rt_tick_t start;
|
|
||||||
|
SET_SCL(ops, 1);
|
||||||
SET_SCL(ops, 1);
|
|
||||||
|
if (!ops->get_scl)
|
||||||
if (!ops->get_scl)
|
goto done;
|
||||||
goto done;
|
|
||||||
|
start = rt_tick_get();
|
||||||
start = rt_tick_get();
|
while (!GET_SCL(ops))
|
||||||
while (!GET_SCL(ops))
|
{
|
||||||
{
|
if ((rt_tick_get() - start) > ops->timeout)
|
||||||
if ((rt_tick_get() - start) > ops->timeout)
|
return -RT_ETIMEOUT;
|
||||||
return -RT_ETIMEOUT;
|
rt_thread_delay((ops->timeout + 1) >> 1);
|
||||||
rt_thread_delay((ops->timeout + 1) >> 1);
|
}
|
||||||
}
|
#ifdef RT_I2C_BIT_DEBUG
|
||||||
#ifdef RT_I2C_BIT_DEBUG
|
if (rt_tick_get() != start)
|
||||||
if (rt_tick_get() != start)
|
{
|
||||||
{
|
bit_dbg("wait %ld tick for SCL line to go high\n",
|
||||||
bit_dbg("wait %ld tick for SCL line to go high\n",
|
rt_tick_get() - start);
|
||||||
rt_tick_get() - start);
|
}
|
||||||
}
|
#endif
|
||||||
#endif
|
|
||||||
|
done:
|
||||||
done:
|
i2c_delay(ops);
|
||||||
i2c_delay(ops);
|
|
||||||
|
return RT_EOK;
|
||||||
return RT_EOK;
|
}
|
||||||
}
|
|
||||||
|
static void i2c_start(struct rt_i2c_bit_ops *ops)
|
||||||
|
{
|
||||||
static void i2c_start(struct rt_i2c_bit_ops *ops)
|
#ifdef RT_I2C_BIT_DEBUG
|
||||||
{
|
if (ops->get_scl && !GET_SCL(ops))
|
||||||
#ifdef RT_I2C_BIT_DEBUG
|
{
|
||||||
if (ops->get_scl && !GET_SCL(ops))
|
bit_dbg("I2C bus error, SCL line low\n");
|
||||||
{
|
}
|
||||||
bit_dbg("I2C bus error, SCL line low\n");
|
if (ops->get_sda && !GET_SDA(ops))
|
||||||
}
|
{
|
||||||
if (ops->get_sda && !GET_SDA(ops))
|
bit_dbg("I2C bus error, SDA line low\n");
|
||||||
{
|
}
|
||||||
bit_dbg("I2C bus error, SDA line low\n");
|
#endif
|
||||||
}
|
SDA_L(ops);
|
||||||
#endif
|
i2c_delay(ops);
|
||||||
SDA_L(ops);
|
SCL_L(ops);
|
||||||
i2c_delay(ops);
|
}
|
||||||
SCL_L(ops);
|
|
||||||
}
|
static void i2c_restart(struct rt_i2c_bit_ops *ops)
|
||||||
|
{
|
||||||
static void i2c_restart(struct rt_i2c_bit_ops *ops)
|
SDA_H(ops);
|
||||||
{
|
SCL_H(ops);
|
||||||
SDA_H(ops);
|
i2c_delay(ops);
|
||||||
SCL_H(ops);
|
SDA_L(ops);
|
||||||
i2c_delay(ops);
|
i2c_delay(ops);
|
||||||
SDA_L(ops);
|
SCL_L(ops);
|
||||||
i2c_delay(ops);
|
}
|
||||||
SCL_L(ops);
|
|
||||||
}
|
static void i2c_stop(struct rt_i2c_bit_ops *ops)
|
||||||
|
{
|
||||||
|
SDA_L(ops);
|
||||||
static void i2c_stop(struct rt_i2c_bit_ops *ops)
|
i2c_delay(ops);
|
||||||
{
|
SCL_H(ops);
|
||||||
SDA_L(ops);
|
i2c_delay(ops);
|
||||||
i2c_delay(ops);
|
SDA_H(ops);
|
||||||
SCL_H(ops);
|
i2c_delay2(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;
|
||||||
rt_inline rt_bool_t i2c_waitack(struct rt_i2c_bit_ops *ops)
|
|
||||||
{
|
SDA_H(ops);
|
||||||
rt_bool_t ack;
|
i2c_delay(ops);
|
||||||
|
|
||||||
SDA_H(ops);
|
if (SCL_H(ops) < 0)
|
||||||
i2c_delay(ops);
|
{
|
||||||
|
bit_dbg("wait ack timeout\n");
|
||||||
if (SCL_H(ops) < 0)
|
|
||||||
{
|
return -RT_ETIMEOUT;
|
||||||
bit_dbg("wait ack timeout\n");
|
}
|
||||||
return -RT_ETIMEOUT;
|
|
||||||
}
|
ack = !GET_SDA(ops); /* ACK : SDA pin is pulled low */
|
||||||
|
bit_dbg("%s\n", ack ? "ACK" : "NACK");
|
||||||
ack = !GET_SDA(ops); /* ACK : SDA pin is pulled low */
|
|
||||||
bit_dbg("%s\n", ack ? "ACK" : "NACK");
|
SCL_L(ops);
|
||||||
|
|
||||||
SCL_L(ops);
|
return ack;
|
||||||
|
}
|
||||||
return ack;
|
|
||||||
}
|
static rt_int32_t i2c_writeb(struct rt_i2c_bus_device *bus, rt_uint8_t data)
|
||||||
|
{
|
||||||
|
rt_int32_t i;
|
||||||
static rt_int32_t i2c_writeb(struct rt_i2c_bus_device *bus, rt_uint8_t data)
|
rt_uint8_t bit;
|
||||||
{
|
|
||||||
rt_int32_t i;
|
struct rt_i2c_bit_ops *ops = bus->priv;
|
||||||
rt_uint8_t bit;
|
|
||||||
|
for (i = 7; i >= 0; i--)
|
||||||
struct rt_i2c_bit_ops *ops = bus->priv;
|
{
|
||||||
|
SCL_L(ops);
|
||||||
for (i = 7; i >= 0; i--)
|
bit = (data >> i) & 1;
|
||||||
{
|
SET_SDA(ops, bit);
|
||||||
SCL_L(ops);
|
i2c_delay(ops);
|
||||||
bit = (data >> i) & 1;
|
if (SCL_H(ops) < 0)
|
||||||
SET_SDA(ops, bit);
|
{
|
||||||
i2c_delay(ops);
|
bit_dbg("i2c_writeb: 0x%02x, "
|
||||||
if (SCL_H(ops) < 0)
|
"wait scl pin high timeout at bit %d\n",
|
||||||
{
|
data, i);
|
||||||
bit_dbg("i2c_writeb: 0x%02x, "
|
|
||||||
"wait scl pin high timeout at bit %d\n",
|
return -RT_ETIMEOUT;
|
||||||
data, i);
|
}
|
||||||
return -RT_ETIMEOUT;
|
}
|
||||||
}
|
SCL_L(ops);
|
||||||
|
i2c_delay(ops);
|
||||||
}
|
|
||||||
SCL_L(ops);
|
return i2c_waitack(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;
|
||||||
static rt_int32_t i2c_readb(struct rt_i2c_bus_device *bus)
|
struct rt_i2c_bit_ops *ops = bus->priv;
|
||||||
{
|
|
||||||
rt_uint8_t i;
|
SDA_H(ops);
|
||||||
rt_uint8_t data = 0;
|
i2c_delay(ops);
|
||||||
struct rt_i2c_bit_ops *ops = bus->priv;
|
for (i = 0; i < 8; i++)
|
||||||
|
{
|
||||||
SDA_H(ops);
|
data <<= 1;
|
||||||
i2c_delay(ops);
|
|
||||||
for (i = 0; i < 8; i++)
|
if (SCL_H(ops) < 0)
|
||||||
{
|
{
|
||||||
data <<= 1;
|
bit_dbg("i2c_readb: wait scl pin high "
|
||||||
|
"timeout at bit %d\n", 7 - i);
|
||||||
if (SCL_H(ops) < 0)
|
|
||||||
{
|
return -RT_ETIMEOUT;
|
||||||
bit_dbg("i2c_readb: wait scl pin high "
|
}
|
||||||
"timeout at bit %d\n", 7 - i);
|
|
||||||
return -RT_ETIMEOUT;
|
if (GET_SDA(ops))
|
||||||
}
|
data |= 1;
|
||||||
|
SCL_L(ops);
|
||||||
if (GET_SDA(ops))
|
i2c_delay2(ops);
|
||||||
data |= 1;
|
}
|
||||||
SCL_L(ops);
|
|
||||||
i2c_delay2(ops);
|
return data;
|
||||||
}
|
}
|
||||||
|
|
||||||
return data;
|
static rt_size_t i2c_send_bytes(struct rt_i2c_bus_device *bus,
|
||||||
}
|
struct rt_i2c_msg *msg)
|
||||||
|
{
|
||||||
|
rt_int32_t ret;
|
||||||
static rt_size_t i2c_send_bytes(struct rt_i2c_bus_device *bus, struct rt_i2c_msg *msg)
|
rt_size_t bytes = 0;
|
||||||
{
|
const rt_uint8_t *ptr = msg->buf;
|
||||||
rt_int32_t ret;
|
rt_int32_t count = msg->len;
|
||||||
rt_size_t bytes = 0;
|
rt_uint16_t ignore_nack = msg->flags & RT_I2C_IGNORE_NACK;
|
||||||
const rt_uint8_t *ptr = msg->buf;
|
|
||||||
rt_int32_t count = msg->len;
|
while (count > 0)
|
||||||
rt_uint16_t ignore_nack = msg->flags & RT_I2C_IGNORE_NACK;
|
{
|
||||||
|
ret = i2c_writeb(bus, *ptr);
|
||||||
while (count > 0)
|
|
||||||
{
|
if ((ret > 0) || (ignore_nack && (ret == 0)))
|
||||||
ret = i2c_writeb(bus, *ptr);
|
{
|
||||||
|
count --;
|
||||||
if ((ret > 0) || (ignore_nack && (ret == 0)))
|
ptr ++;
|
||||||
{
|
bytes ++;
|
||||||
count--;
|
}
|
||||||
ptr++;
|
else if (ret == 0)
|
||||||
bytes++;
|
{
|
||||||
}
|
i2c_dbg("send bytes: NACK.\n");
|
||||||
else if (ret == 0)
|
|
||||||
{
|
return 0;
|
||||||
i2c_dbg("send bytes: NACK.\n");
|
}
|
||||||
return 0;
|
else
|
||||||
}
|
{
|
||||||
else
|
i2c_dbg("send bytes: error %d\n", ret);
|
||||||
{
|
|
||||||
i2c_dbg("send bytes: error %d\n", ret);
|
return ret;
|
||||||
return ret;
|
}
|
||||||
}
|
}
|
||||||
}
|
|
||||||
return bytes;
|
return bytes;
|
||||||
}
|
}
|
||||||
|
|
||||||
static rt_err_t i2c_send_ack_or_nack(struct rt_i2c_bus_device *bus, int ack)
|
static rt_err_t i2c_send_ack_or_nack(struct rt_i2c_bus_device *bus, int ack)
|
||||||
{
|
{
|
||||||
struct rt_i2c_bit_ops *ops = bus->priv;
|
struct rt_i2c_bit_ops *ops = bus->priv;
|
||||||
|
|
||||||
if (ack)
|
if (ack)
|
||||||
SET_SDA(ops, 0);
|
SET_SDA(ops, 0);
|
||||||
i2c_delay(ops);
|
i2c_delay(ops);
|
||||||
if (SCL_H(ops) < 0)
|
if (SCL_H(ops) < 0)
|
||||||
{
|
{
|
||||||
bit_dbg("ACK or NACK timeout\n");
|
bit_dbg("ACK or NACK timeout\n");
|
||||||
return -RT_ETIMEOUT;
|
|
||||||
}
|
return -RT_ETIMEOUT;
|
||||||
SCL_L(ops);
|
}
|
||||||
return RT_EOK;
|
SCL_L(ops);
|
||||||
}
|
|
||||||
|
return RT_EOK;
|
||||||
static rt_size_t i2c_recv_bytes(struct rt_i2c_bus_device *bus, struct rt_i2c_msg *msg)
|
}
|
||||||
{
|
|
||||||
rt_int32_t val;
|
static rt_size_t i2c_recv_bytes(struct rt_i2c_bus_device *bus,
|
||||||
rt_int32_t bytes = 0; /* actual bytes */
|
struct rt_i2c_msg *msg)
|
||||||
rt_uint8_t *ptr = msg->buf;
|
{
|
||||||
rt_int32_t count = msg->len;
|
rt_int32_t val;
|
||||||
const rt_uint32_t flags = msg->flags;
|
rt_int32_t bytes = 0; /* actual bytes */
|
||||||
|
rt_uint8_t *ptr = msg->buf;
|
||||||
while (count > 0)
|
rt_int32_t count = msg->len;
|
||||||
{
|
const rt_uint32_t flags = msg->flags;
|
||||||
val = i2c_readb(bus);
|
|
||||||
if (val >= 0)
|
while (count > 0)
|
||||||
{
|
{
|
||||||
*ptr = val;
|
val = i2c_readb(bus);
|
||||||
bytes++;
|
if (val >= 0)
|
||||||
}
|
{
|
||||||
else
|
*ptr = val;
|
||||||
{
|
bytes ++;
|
||||||
break;
|
}
|
||||||
}
|
else
|
||||||
|
{
|
||||||
ptr++;
|
break;
|
||||||
count--;
|
}
|
||||||
|
|
||||||
bit_dbg("recieve bytes: 0x%02x, %s\n",
|
ptr ++;
|
||||||
val, (flags & RT_I2C_NO_READ_ACK) ?
|
count --;
|
||||||
"(No ACK/NACK)" : (count ? "ACK" : "NACK"));
|
|
||||||
|
bit_dbg("recieve bytes: 0x%02x, %s\n",
|
||||||
if (!(flags & RT_I2C_NO_READ_ACK))
|
val, (flags & RT_I2C_NO_READ_ACK) ?
|
||||||
{
|
"(No ACK/NACK)" : (count ? "ACK" : "NACK"));
|
||||||
val = i2c_send_ack_or_nack(bus, count);
|
|
||||||
if (val < 0)
|
if (!(flags & RT_I2C_NO_READ_ACK))
|
||||||
return val;
|
{
|
||||||
}
|
val = i2c_send_ack_or_nack(bus, count);
|
||||||
}
|
if (val < 0)
|
||||||
return bytes;
|
return val;
|
||||||
}
|
}
|
||||||
|
}
|
||||||
static rt_int32_t i2c_send_address(struct rt_i2c_bus_device *bus,
|
|
||||||
rt_uint8_t addr, rt_int32_t retries)
|
return bytes;
|
||||||
{
|
}
|
||||||
struct rt_i2c_bit_ops *ops = bus->priv;
|
|
||||||
rt_int32_t i;
|
static rt_int32_t i2c_send_address(struct rt_i2c_bus_device *bus,
|
||||||
rt_err_t ret = 0;
|
rt_uint8_t addr,
|
||||||
|
rt_int32_t retries)
|
||||||
for (i = 0; i <= retries; i++)
|
{
|
||||||
{
|
struct rt_i2c_bit_ops *ops = bus->priv;
|
||||||
ret = i2c_writeb(bus, addr);
|
rt_int32_t i;
|
||||||
if (ret == 1 || i == retries)
|
rt_err_t ret = 0;
|
||||||
break;
|
|
||||||
bit_dbg("send stop condition\n");
|
for (i = 0; i <= retries; i++)
|
||||||
i2c_stop(ops);
|
{
|
||||||
i2c_delay2(ops);
|
ret = i2c_writeb(bus, addr);
|
||||||
bit_dbg("send start condition\n");
|
if (ret == 1 || i == retries)
|
||||||
i2c_start(ops);
|
break;
|
||||||
}
|
bit_dbg("send stop condition\n");
|
||||||
|
i2c_stop(ops);
|
||||||
return ret;
|
i2c_delay2(ops);
|
||||||
}
|
bit_dbg("send start condition\n");
|
||||||
|
i2c_start(ops);
|
||||||
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;
|
return ret;
|
||||||
rt_uint16_t ignore_nack = msg->flags & RT_I2C_IGNORE_NACK;
|
}
|
||||||
struct rt_i2c_bit_ops *ops = bus->priv;
|
|
||||||
|
static rt_err_t i2c_bit_send_address(struct rt_i2c_bus_device *bus,
|
||||||
rt_uint8_t addr1, addr2;
|
struct rt_i2c_msg *msg)
|
||||||
rt_int32_t retries;
|
{
|
||||||
rt_err_t ret;
|
rt_uint16_t flags = msg->flags;
|
||||||
|
rt_uint16_t ignore_nack = msg->flags & RT_I2C_IGNORE_NACK;
|
||||||
retries = ignore_nack ? 0 : bus->retries;
|
struct rt_i2c_bit_ops *ops = bus->priv;
|
||||||
|
|
||||||
if (flags & RT_I2C_ADDR_10BIT)
|
rt_uint8_t addr1, addr2;
|
||||||
{
|
rt_int32_t retries;
|
||||||
addr1 = 0xf0 | ((msg->addr >> 7) & 0x06);
|
rt_err_t ret;
|
||||||
addr2 = msg->addr & 0xff;
|
|
||||||
|
retries = ignore_nack ? 0 : bus->retries;
|
||||||
bit_dbg("addr1: %d, addr2: %d\n", addr1, addr2);
|
|
||||||
|
if (flags & RT_I2C_ADDR_10BIT)
|
||||||
ret = i2c_send_address(bus, addr1, retries);
|
{
|
||||||
if ((ret != 1) && !ignore_nack)
|
addr1 = 0xf0 | ((msg->addr >> 7) & 0x06);
|
||||||
{
|
addr2 = msg->addr & 0xff;
|
||||||
bit_dbg("NACK: sending first addr\n");
|
|
||||||
return -RT_EIO;
|
bit_dbg("addr1: %d, addr2: %d\n", addr1, addr2);
|
||||||
}
|
|
||||||
|
ret = i2c_send_address(bus, addr1, retries);
|
||||||
ret = i2c_writeb(bus, addr2);
|
if ((ret != 1) && !ignore_nack)
|
||||||
if ((ret != 1) && !ignore_nack)
|
{
|
||||||
{
|
bit_dbg("NACK: sending first addr\n");
|
||||||
bit_dbg("NACK: sending second addr\n");
|
|
||||||
return -RT_EIO;
|
return -RT_EIO;
|
||||||
}
|
}
|
||||||
if (flags & RT_I2C_RD)
|
|
||||||
{
|
ret = i2c_writeb(bus, addr2);
|
||||||
bit_dbg("send repeated start condition\n");
|
if ((ret != 1) && !ignore_nack)
|
||||||
i2c_restart(ops);
|
{
|
||||||
addr1 |= 0x01;
|
bit_dbg("NACK: sending second addr\n");
|
||||||
ret = i2c_send_address(bus, addr1, retries);
|
|
||||||
if ((ret != 1) && !ignore_nack)
|
return -RT_EIO;
|
||||||
{
|
}
|
||||||
bit_dbg("NACK: sending repeated addr\n");
|
if (flags & RT_I2C_RD)
|
||||||
return -RT_EIO;
|
{
|
||||||
}
|
bit_dbg("send repeated start condition\n");
|
||||||
}
|
i2c_restart(ops);
|
||||||
}
|
addr1 |= 0x01;
|
||||||
else
|
ret = i2c_send_address(bus, addr1, retries);
|
||||||
{
|
if ((ret != 1) && !ignore_nack)
|
||||||
/* 7-bit addr */
|
{
|
||||||
addr1 = msg->addr << 1;
|
bit_dbg("NACK: sending repeated addr\n");
|
||||||
if (flags & RT_I2C_RD)
|
|
||||||
addr1 |= 1;
|
return -RT_EIO;
|
||||||
ret = i2c_send_address(bus, addr1, retries);
|
}
|
||||||
if ((ret != 1) && !ignore_nack)
|
}
|
||||||
return -RT_EIO;
|
}
|
||||||
}
|
else
|
||||||
|
{
|
||||||
return RT_EOK;
|
/* 7-bit addr */
|
||||||
}
|
addr1 = msg->addr << 1;
|
||||||
|
if (flags & RT_I2C_RD)
|
||||||
|
addr1 |= 1;
|
||||||
static rt_size_t i2c_bit_xfer(struct rt_i2c_bus_device *bus,
|
ret = i2c_send_address(bus, addr1, retries);
|
||||||
struct rt_i2c_msg msgs[], rt_uint32_t num)
|
if ((ret != 1) && !ignore_nack)
|
||||||
{
|
return -RT_EIO;
|
||||||
struct rt_i2c_msg *msg;
|
}
|
||||||
struct rt_i2c_bit_ops *ops = bus->priv;
|
|
||||||
rt_int32_t i, ret;
|
return RT_EOK;
|
||||||
rt_uint16_t ignore_nack;
|
}
|
||||||
|
|
||||||
bit_dbg("send start condition\n");
|
static rt_size_t i2c_bit_xfer(struct rt_i2c_bus_device *bus,
|
||||||
i2c_start(ops);
|
struct rt_i2c_msg msgs[],
|
||||||
for (i = 0; i < num; i++)
|
rt_uint32_t num)
|
||||||
{
|
{
|
||||||
msg = &msgs[i];
|
struct rt_i2c_msg *msg;
|
||||||
ignore_nack = msg->flags & RT_I2C_IGNORE_NACK;
|
struct rt_i2c_bit_ops *ops = bus->priv;
|
||||||
if (!(msg->flags & RT_I2C_NO_START))
|
rt_int32_t i, ret;
|
||||||
{
|
rt_uint16_t ignore_nack;
|
||||||
if (i)
|
|
||||||
{
|
bit_dbg("send start condition\n");
|
||||||
i2c_restart(ops);
|
i2c_start(ops);
|
||||||
}
|
for (i = 0; i < num; i++)
|
||||||
ret = i2c_bit_send_address(bus, msg);
|
{
|
||||||
if ((ret != RT_EOK) && !ignore_nack)
|
msg = &msgs[i];
|
||||||
{
|
ignore_nack = msg->flags & RT_I2C_IGNORE_NACK;
|
||||||
bit_dbg("receive NACK from device addr 0x%02x msg %d\n",
|
if (!(msg->flags & RT_I2C_NO_START))
|
||||||
msgs[i].addr, i);
|
{
|
||||||
goto out;
|
if (i)
|
||||||
}
|
{
|
||||||
}
|
i2c_restart(ops);
|
||||||
if (msg->flags & RT_I2C_RD)
|
}
|
||||||
{
|
ret = i2c_bit_send_address(bus, msg);
|
||||||
ret = i2c_recv_bytes(bus, msg);
|
if ((ret != RT_EOK) && !ignore_nack)
|
||||||
if (ret >= 1)
|
{
|
||||||
bit_dbg("read %d byte%s\n",
|
bit_dbg("receive NACK from device addr 0x%02x msg %d\n",
|
||||||
ret, ret == 1 ? "" : "s");
|
msgs[i].addr, i);
|
||||||
if (ret < msg->len)
|
goto out;
|
||||||
{
|
}
|
||||||
if (ret >= 0)
|
}
|
||||||
ret = -RT_EIO;
|
if (msg->flags & RT_I2C_RD)
|
||||||
goto out;
|
{
|
||||||
}
|
ret = i2c_recv_bytes(bus, msg);
|
||||||
}
|
if (ret >= 1)
|
||||||
else
|
bit_dbg("read %d byte%s\n", ret, ret == 1 ? "" : "s");
|
||||||
{
|
if (ret < msg->len)
|
||||||
ret = i2c_send_bytes(bus, msg);
|
{
|
||||||
if (ret >= 1)
|
if (ret >= 0)
|
||||||
bit_dbg("write %d byte%s\n",
|
ret = -RT_EIO;
|
||||||
ret, ret == 1 ? "" : "s");
|
goto out;
|
||||||
if (ret < msg->len)
|
}
|
||||||
{
|
}
|
||||||
if (ret >= 0)
|
else
|
||||||
ret = -RT_ERROR;
|
{
|
||||||
goto out;
|
ret = i2c_send_bytes(bus, msg);
|
||||||
}
|
if (ret >= 1)
|
||||||
}
|
bit_dbg("write %d byte%s\n", ret, ret == 1 ? "" : "s");
|
||||||
}
|
if (ret < msg->len)
|
||||||
ret = i;
|
{
|
||||||
|
if (ret >= 0)
|
||||||
out:
|
ret = -RT_ERROR;
|
||||||
bit_dbg("send stop condition\n");
|
goto out;
|
||||||
i2c_stop(ops);
|
}
|
||||||
|
}
|
||||||
return ret;
|
}
|
||||||
}
|
ret = i;
|
||||||
|
|
||||||
|
out:
|
||||||
static const struct rt_i2c_bus_device_ops i2c_bit_bus_ops =
|
bit_dbg("send stop condition\n");
|
||||||
{
|
i2c_stop(ops);
|
||||||
i2c_bit_xfer,
|
|
||||||
RT_NULL,
|
return ret;
|
||||||
RT_NULL
|
}
|
||||||
};
|
|
||||||
|
static const struct rt_i2c_bus_device_ops i2c_bit_bus_ops =
|
||||||
|
{
|
||||||
rt_err_t rt_i2c_bit_add_bus(struct rt_i2c_bus_device *bus, const char *bus_name)
|
i2c_bit_xfer,
|
||||||
{
|
RT_NULL,
|
||||||
struct rt_i2c_bit_ops *bit_ops = bus->priv;
|
RT_NULL
|
||||||
RT_ASSERT(bit_ops != RT_NULL);
|
};
|
||||||
|
|
||||||
bus->ops = &i2c_bit_bus_ops;
|
rt_err_t rt_i2c_bit_add_bus(struct rt_i2c_bus_device *bus,
|
||||||
|
const char *bus_name)
|
||||||
return rt_i2c_bus_device_register(bus, bus_name);
|
{
|
||||||
}
|
struct rt_i2c_bit_ops *bit_ops = bus->priv;
|
||||||
|
RT_ASSERT(bit_ops != RT_NULL);
|
||||||
|
|
||||||
|
bus->ops = &i2c_bit_bus_ops;
|
||||||
|
|
||||||
|
return rt_i2c_bus_device_register(bus, bus_name);
|
||||||
|
}
|
||||||
|
@ -1,135 +1,131 @@
|
|||||||
/*
|
/*
|
||||||
* File : i2c_core.c
|
* File : i2c_core.c
|
||||||
* This file is part of RT-Thread RTOS
|
* This file is part of RT-Thread RTOS
|
||||||
* COPYRIGHT (C) 2006, RT-Thread Development Team
|
* COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
||||||
*
|
*
|
||||||
* The license and distribution terms for this file may be
|
* The license and distribution terms for this file may be
|
||||||
* found in the file LICENSE in this distribution or at
|
* found in the file LICENSE in this distribution or at
|
||||||
* http://www.rt-thread.org/license/LICENSE
|
* http://www.rt-thread.org/license/LICENSE
|
||||||
*
|
*
|
||||||
* Change Logs:
|
* Change Logs:
|
||||||
* Date Author Notes
|
* Date Author Notes
|
||||||
* 2012-04-25 weety first version
|
* 2012-04-25 weety first version
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <rtdevice.h>
|
#include <rtdevice.h>
|
||||||
|
|
||||||
static struct rt_mutex i2c_core_lock;
|
static struct rt_mutex i2c_core_lock;
|
||||||
|
|
||||||
rt_err_t rt_i2c_bus_device_register(struct rt_i2c_bus_device *bus,
|
rt_err_t rt_i2c_bus_device_register(struct rt_i2c_bus_device *bus,
|
||||||
const char *bus_name)
|
const char *bus_name)
|
||||||
{
|
{
|
||||||
rt_err_t res = RT_EOK;
|
rt_err_t res = RT_EOK;
|
||||||
|
|
||||||
rt_mutex_init(&bus->lock, "i2c_bus_lock", RT_IPC_FLAG_FIFO);
|
rt_mutex_init(&bus->lock, "i2c_bus_lock", RT_IPC_FLAG_FIFO);
|
||||||
|
|
||||||
rt_mutex_take(&i2c_core_lock, RT_WAITING_FOREVER);
|
rt_mutex_take(&i2c_core_lock, RT_WAITING_FOREVER);
|
||||||
|
|
||||||
if (bus->timeout == 0)
|
if (bus->timeout == 0)
|
||||||
bus->timeout = RT_TICK_PER_SECOND;
|
bus->timeout = RT_TICK_PER_SECOND;
|
||||||
|
|
||||||
res = rt_i2c_bus_device_device_init(bus, bus_name);
|
res = rt_i2c_bus_device_device_init(bus, bus_name);
|
||||||
|
|
||||||
i2c_dbg("I2C bus [%s] registered\n", bus_name);
|
i2c_dbg("I2C bus [%s] registered\n", bus_name);
|
||||||
|
|
||||||
rt_mutex_release(&i2c_core_lock);
|
rt_mutex_release(&i2c_core_lock);
|
||||||
return res;
|
|
||||||
}
|
return res;
|
||||||
|
}
|
||||||
|
|
||||||
struct rt_i2c_bus_device* rt_i2c_bus_device_find(const char *bus_name)
|
struct rt_i2c_bus_device *rt_i2c_bus_device_find(const char *bus_name)
|
||||||
{
|
{
|
||||||
struct rt_i2c_bus_device *bus;
|
struct rt_i2c_bus_device *bus;
|
||||||
rt_device_t dev = rt_device_find(bus_name);
|
rt_device_t dev = rt_device_find(bus_name);
|
||||||
if (dev == RT_NULL || dev->type != RT_Device_Class_I2CBUS)
|
if (dev == RT_NULL || dev->type != RT_Device_Class_I2CBUS)
|
||||||
{
|
{
|
||||||
i2c_dbg("I2C bus %s not exist\n", bus_name);
|
i2c_dbg("I2C bus %s not exist\n", bus_name);
|
||||||
return RT_NULL;
|
|
||||||
}
|
return RT_NULL;
|
||||||
|
}
|
||||||
bus = (struct rt_i2c_bus_device *)dev->user_data;
|
|
||||||
|
bus = (struct rt_i2c_bus_device *)dev->user_data;
|
||||||
return bus;
|
|
||||||
}
|
return bus;
|
||||||
|
}
|
||||||
|
|
||||||
rt_size_t rt_i2c_transfer(struct rt_i2c_bus_device *bus,
|
rt_size_t rt_i2c_transfer(struct rt_i2c_bus_device *bus,
|
||||||
struct rt_i2c_msg msgs[],
|
struct rt_i2c_msg msgs[],
|
||||||
rt_uint32_t num)
|
rt_uint32_t num)
|
||||||
{
|
{
|
||||||
rt_size_t ret;
|
rt_size_t ret;
|
||||||
|
|
||||||
if (bus->ops->master_xfer)
|
if (bus->ops->master_xfer)
|
||||||
{
|
{
|
||||||
#ifdef RT_I2C_DEBUG
|
#ifdef RT_I2C_DEBUG
|
||||||
for (ret = 0; ret < num; ret++)
|
for (ret = 0; ret < num; ret++)
|
||||||
{
|
{
|
||||||
i2c_dbg("msgs[%d] %c, addr=0x%02x, len=%d%s\n", ret,
|
i2c_dbg("msgs[%d] %c, addr=0x%02x, len=%d%s\n", ret,
|
||||||
(msgs[ret].flags & RT_I2C_RD) ? 'R' : 'W',
|
(msgs[ret].flags & RT_I2C_RD) ? 'R' : 'W',
|
||||||
msgs[ret].addr, msgs[ret].len);
|
msgs[ret].addr, msgs[ret].len);
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
rt_mutex_take(&bus->lock, RT_WAITING_FOREVER);
|
rt_mutex_take(&bus->lock, RT_WAITING_FOREVER);
|
||||||
ret = bus->ops->master_xfer(bus, msgs, num);
|
ret = bus->ops->master_xfer(bus, msgs, num);
|
||||||
rt_mutex_release(&bus->lock);
|
rt_mutex_release(&bus->lock);
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
i2c_dbg("I2C bus operation not supported\n");
|
i2c_dbg("I2C bus operation not supported\n");
|
||||||
return 0;
|
|
||||||
}
|
return 0;
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
rt_size_t rt_i2c_master_send(struct rt_i2c_bus_device *bus,
|
rt_size_t rt_i2c_master_send(struct rt_i2c_bus_device *bus,
|
||||||
rt_uint16_t addr,
|
rt_uint16_t addr,
|
||||||
rt_uint16_t flags,
|
rt_uint16_t flags,
|
||||||
const rt_uint8_t *buf,
|
const rt_uint8_t *buf,
|
||||||
rt_uint32_t count)
|
rt_uint32_t count)
|
||||||
{
|
{
|
||||||
rt_size_t ret;
|
rt_size_t ret;
|
||||||
struct rt_i2c_msg msg;
|
struct rt_i2c_msg msg;
|
||||||
|
|
||||||
msg.addr = addr;
|
msg.addr = addr;
|
||||||
msg.flags = flags & RT_I2C_ADDR_10BIT;
|
msg.flags = flags & RT_I2C_ADDR_10BIT;
|
||||||
msg.len = count;
|
msg.len = count;
|
||||||
msg.buf = (rt_uint8_t *)buf;
|
msg.buf = (rt_uint8_t *)buf;
|
||||||
|
|
||||||
ret = rt_i2c_transfer(bus, &msg, 1);
|
ret = rt_i2c_transfer(bus, &msg, 1);
|
||||||
|
|
||||||
return (ret > 0) ? count : ret;
|
return (ret > 0) ? count : ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
rt_size_t rt_i2c_master_recv(struct rt_i2c_bus_device *bus,
|
||||||
|
rt_uint16_t addr,
|
||||||
rt_size_t rt_i2c_master_recv(struct rt_i2c_bus_device *bus,
|
rt_uint16_t flags,
|
||||||
rt_uint16_t addr,
|
rt_uint8_t *buf,
|
||||||
rt_uint16_t flags,
|
rt_uint32_t count)
|
||||||
rt_uint8_t *buf,
|
{
|
||||||
rt_uint32_t count)
|
rt_size_t ret;
|
||||||
{
|
struct rt_i2c_msg msg;
|
||||||
rt_size_t ret;
|
RT_ASSERT(bus != RT_NULL);
|
||||||
struct rt_i2c_msg msg;
|
|
||||||
RT_ASSERT(bus != RT_NULL);
|
msg.addr = addr;
|
||||||
|
msg.flags = flags & RT_I2C_ADDR_10BIT;
|
||||||
msg.addr = addr;
|
msg.flags |= RT_I2C_RD;
|
||||||
msg.flags = flags & RT_I2C_ADDR_10BIT;
|
msg.len = count;
|
||||||
msg.flags |= RT_I2C_RD;
|
msg.buf = buf;
|
||||||
msg.len = count;
|
|
||||||
msg.buf = buf;
|
ret = rt_i2c_transfer(bus, &msg, 1);
|
||||||
|
|
||||||
ret = rt_i2c_transfer(bus, &msg, 1);
|
return (ret > 0) ? count : ret;
|
||||||
|
}
|
||||||
return (ret > 0) ? count : ret;
|
|
||||||
}
|
rt_err_t rt_i2c_core_init(void)
|
||||||
|
{
|
||||||
|
return rt_mutex_init(&i2c_core_lock, "i2c_core_lock", RT_IPC_FLAG_FIFO);
|
||||||
rt_err_t rt_i2c_core_init(void)
|
}
|
||||||
{
|
|
||||||
|
|
||||||
return rt_mutex_init (&i2c_core_lock, "i2c_core_lock", RT_IPC_FLAG_FIFO);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
@ -1,113 +1,126 @@
|
|||||||
#include <rtdevice.h>
|
/*
|
||||||
|
* File : i2c_dev.c
|
||||||
static rt_err_t i2c_bus_device_init(rt_device_t dev)
|
* This file is part of RT-Thread RTOS
|
||||||
{
|
* COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
||||||
struct rt_i2c_bus_device* bus = (struct rt_i2c_bus_device *)dev->user_data;
|
*
|
||||||
RT_ASSERT(bus != RT_NULL);
|
* The license and distribution terms for this file may be
|
||||||
|
* found in the file LICENSE in this distribution or at
|
||||||
return RT_EOK;
|
* http://www.rt-thread.org/license/LICENSE
|
||||||
}
|
*
|
||||||
|
* Change Logs:
|
||||||
static rt_size_t i2c_bus_device_read (rt_device_t dev,
|
* Date Author Notes
|
||||||
rt_off_t pos,
|
* 2012-04-25 weety first version
|
||||||
void *buffer,
|
*/
|
||||||
rt_size_t count)
|
|
||||||
{
|
#include <rtdevice.h>
|
||||||
rt_uint16_t addr;
|
|
||||||
rt_uint16_t flags;
|
static rt_err_t i2c_bus_device_init(rt_device_t dev)
|
||||||
struct rt_i2c_bus_device* bus = (struct rt_i2c_bus_device *)dev->user_data;
|
{
|
||||||
|
struct rt_i2c_bus_device *bus = (struct rt_i2c_bus_device *)dev->user_data;
|
||||||
RT_ASSERT(bus != RT_NULL);
|
RT_ASSERT(bus != RT_NULL);
|
||||||
RT_ASSERT(buffer != RT_NULL);
|
|
||||||
|
return RT_EOK;
|
||||||
i2c_dbg("I2C bus dev [%s] reading %u bytes.\n", dev->parent.name, count);
|
}
|
||||||
|
|
||||||
addr = pos & 0xffff;
|
static rt_size_t i2c_bus_device_read(rt_device_t dev,
|
||||||
flags = (pos >> 16) & 0xffff;
|
rt_off_t pos,
|
||||||
|
void *buffer,
|
||||||
return rt_i2c_master_recv(bus, addr, flags, buffer, count);
|
rt_size_t count)
|
||||||
}
|
{
|
||||||
|
rt_uint16_t addr;
|
||||||
|
rt_uint16_t flags;
|
||||||
static rt_size_t i2c_bus_device_write (rt_device_t dev,
|
struct rt_i2c_bus_device *bus = (struct rt_i2c_bus_device *)dev->user_data;
|
||||||
rt_off_t pos,
|
|
||||||
const void *buffer,
|
RT_ASSERT(bus != RT_NULL);
|
||||||
rt_size_t count)
|
RT_ASSERT(buffer != RT_NULL);
|
||||||
{
|
|
||||||
rt_uint16_t addr;
|
i2c_dbg("I2C bus dev [%s] reading %u bytes.\n", dev->parent.name, count);
|
||||||
rt_uint16_t flags;
|
|
||||||
struct rt_i2c_bus_device* bus = (struct rt_i2c_bus_device *)dev->user_data;
|
addr = pos & 0xffff;
|
||||||
|
flags = (pos >> 16) & 0xffff;
|
||||||
RT_ASSERT(bus != RT_NULL);
|
|
||||||
RT_ASSERT(buffer != RT_NULL);
|
return rt_i2c_master_recv(bus, addr, flags, buffer, count);
|
||||||
|
}
|
||||||
i2c_dbg("I2C bus dev writing %u bytes.\n", dev->parent.name, count);
|
|
||||||
|
static rt_size_t i2c_bus_device_write(rt_device_t dev,
|
||||||
addr = pos & 0xffff;
|
rt_off_t pos,
|
||||||
flags = (pos >> 16) & 0xffff;
|
const void *buffer,
|
||||||
|
rt_size_t count)
|
||||||
return rt_i2c_master_send(bus, addr, flags, buffer, count);
|
{
|
||||||
}
|
rt_uint16_t addr;
|
||||||
|
rt_uint16_t flags;
|
||||||
static rt_err_t i2c_bus_device_control(rt_device_t dev,
|
struct rt_i2c_bus_device *bus = (struct rt_i2c_bus_device *)dev->user_data;
|
||||||
rt_uint8_t cmd,
|
|
||||||
void *args)
|
RT_ASSERT(bus != RT_NULL);
|
||||||
{
|
RT_ASSERT(buffer != RT_NULL);
|
||||||
rt_err_t ret;
|
|
||||||
struct rt_i2c_priv_data *priv_data;
|
i2c_dbg("I2C bus dev writing %u bytes.\n", dev->parent.name, count);
|
||||||
struct rt_i2c_bus_device* bus = (struct rt_i2c_bus_device *)dev->user_data;
|
|
||||||
|
addr = pos & 0xffff;
|
||||||
RT_ASSERT(bus != RT_NULL);
|
flags = (pos >> 16) & 0xffff;
|
||||||
|
|
||||||
switch (cmd)
|
return rt_i2c_master_send(bus, addr, flags, buffer, count);
|
||||||
{
|
}
|
||||||
case RT_I2C_DEV_CTRL_10BIT: /* set 10-bit addr mode */
|
|
||||||
bus->flags |= RT_I2C_ADDR_10BIT;
|
static rt_err_t i2c_bus_device_control(rt_device_t dev,
|
||||||
break;
|
rt_uint8_t cmd,
|
||||||
case RT_I2C_DEV_CTRL_ADDR:
|
void *args)
|
||||||
bus->addr = *(rt_uint16_t *)args;
|
{
|
||||||
break;
|
rt_err_t ret;
|
||||||
case RT_I2C_DEV_CTRL_TIMEOUT:
|
struct rt_i2c_priv_data *priv_data;
|
||||||
bus->timeout = *(rt_uint32_t *)args;
|
struct rt_i2c_bus_device *bus = (struct rt_i2c_bus_device *)dev->user_data;
|
||||||
break;
|
|
||||||
case RT_I2C_DEV_CTRL_RW:
|
RT_ASSERT(bus != RT_NULL);
|
||||||
priv_data = (struct rt_i2c_priv_data *)args;
|
|
||||||
ret = rt_i2c_transfer(bus, priv_data->msgs, priv_data->number);
|
switch (cmd)
|
||||||
if (ret < 0)
|
{
|
||||||
{
|
/* set 10-bit addr mode */
|
||||||
return -RT_EIO;
|
case RT_I2C_DEV_CTRL_10BIT:
|
||||||
}
|
bus->flags |= RT_I2C_ADDR_10BIT;
|
||||||
break;
|
break;
|
||||||
default:
|
case RT_I2C_DEV_CTRL_ADDR:
|
||||||
break;
|
bus->addr = *(rt_uint16_t *)args;
|
||||||
}
|
break;
|
||||||
|
case RT_I2C_DEV_CTRL_TIMEOUT:
|
||||||
return RT_EOK;
|
bus->timeout = *(rt_uint32_t *)args;
|
||||||
}
|
break;
|
||||||
|
case RT_I2C_DEV_CTRL_RW:
|
||||||
|
priv_data = (struct rt_i2c_priv_data *)args;
|
||||||
rt_err_t rt_i2c_bus_device_device_init(struct rt_i2c_bus_device* bus,
|
ret = rt_i2c_transfer(bus, priv_data->msgs, priv_data->number);
|
||||||
const char* name)
|
if (ret < 0)
|
||||||
{
|
{
|
||||||
struct rt_device *device;
|
return -RT_EIO;
|
||||||
RT_ASSERT(bus != RT_NULL);
|
}
|
||||||
|
break;
|
||||||
device = &bus->parent;
|
default:
|
||||||
|
break;
|
||||||
device->user_data = bus;
|
}
|
||||||
|
|
||||||
/* set device type */
|
return RT_EOK;
|
||||||
device->type = RT_Device_Class_I2CBUS;
|
}
|
||||||
/* initialize device interface */
|
|
||||||
device->init = i2c_bus_device_init;
|
rt_err_t rt_i2c_bus_device_device_init(struct rt_i2c_bus_device *bus,
|
||||||
device->open = RT_NULL;
|
const char *name)
|
||||||
device->close = RT_NULL;
|
{
|
||||||
device->read = i2c_bus_device_read;
|
struct rt_device *device;
|
||||||
device->write = i2c_bus_device_write;
|
RT_ASSERT(bus != RT_NULL);
|
||||||
device->control = i2c_bus_device_control;
|
|
||||||
|
device = &bus->parent;
|
||||||
/* register to device manager */
|
|
||||||
rt_device_register(device, name, RT_DEVICE_FLAG_RDWR);
|
device->user_data = bus;
|
||||||
|
|
||||||
return RT_EOK;
|
/* set device type */
|
||||||
}
|
device->type = RT_Device_Class_I2CBUS;
|
||||||
|
/* initialize device interface */
|
||||||
|
device->init = i2c_bus_device_init;
|
||||||
|
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;
|
||||||
|
|
||||||
|
/* register to device manager */
|
||||||
|
rt_device_register(device, name, RT_DEVICE_FLAG_RDWR);
|
||||||
|
|
||||||
|
return RT_EOK;
|
||||||
|
}
|
||||||
|
@ -1,43 +1,43 @@
|
|||||||
/*
|
/*
|
||||||
* File : i2c-bit-ops.h
|
* File : i2c-bit-ops.h
|
||||||
* This file is part of RT-Thread RTOS
|
* This file is part of RT-Thread RTOS
|
||||||
* COPYRIGHT (C) 2006, RT-Thread Development Team
|
* COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
||||||
*
|
*
|
||||||
* The license and distribution terms for this file may be
|
* The license and distribution terms for this file may be
|
||||||
* found in the file LICENSE in this distribution or at
|
* found in the file LICENSE in this distribution or at
|
||||||
* http://www.rt-thread.org/license/LICENSE
|
* http://www.rt-thread.org/license/LICENSE
|
||||||
*
|
*
|
||||||
* Change Logs:
|
* Change Logs:
|
||||||
* Date Author Notes
|
* Date Author Notes
|
||||||
* 2012-04-25 weety first version
|
* 2012-04-25 weety first version
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef __I2C_BIT_OPS_H__
|
#ifndef __I2C_BIT_OPS_H__
|
||||||
#define __I2C_BIT_OPS_H__
|
#define __I2C_BIT_OPS_H__
|
||||||
|
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
extern "C" {
|
extern "C" {
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
struct rt_i2c_bit_ops
|
struct rt_i2c_bit_ops
|
||||||
{
|
{
|
||||||
void *data; /* private data for lowlevel routines */
|
void *data; /* private data for lowlevel routines */
|
||||||
void (*set_sda) (void *data, rt_int32_t state);
|
void (*set_sda)(void *data, rt_int32_t state);
|
||||||
void (*set_scl) (void *data, rt_int32_t state);
|
void (*set_scl)(void *data, rt_int32_t state);
|
||||||
rt_int32_t (*get_sda) (void *data);
|
rt_int32_t (*get_sda)(void *data);
|
||||||
rt_int32_t (*get_scl) (void *data);
|
rt_int32_t (*get_scl)(void *data);
|
||||||
|
|
||||||
void (*udelay) (rt_uint32_t us);
|
void (*udelay)(rt_uint32_t us);
|
||||||
|
|
||||||
rt_uint32_t delay_us; /* scl and sda line delay */
|
rt_uint32_t delay_us; /* scl and sda line delay */
|
||||||
rt_uint32_t timeout; /* in tick */
|
rt_uint32_t timeout; /* in tick */
|
||||||
};
|
};
|
||||||
|
|
||||||
rt_err_t rt_i2c_bit_add_bus(struct rt_i2c_bus_device *bus,
|
rt_err_t rt_i2c_bit_add_bus(struct rt_i2c_bus_device *bus,
|
||||||
const char *bus_name);
|
const char *bus_name);
|
||||||
|
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
@ -1,95 +1,95 @@
|
|||||||
/*
|
/*
|
||||||
* File : i2c.h
|
* File : i2c.h
|
||||||
* This file is part of RT-Thread RTOS
|
* This file is part of RT-Thread RTOS
|
||||||
* COPYRIGHT (C) 2006, RT-Thread Development Team
|
* COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
||||||
*
|
*
|
||||||
* The license and distribution terms for this file may be
|
* The license and distribution terms for this file may be
|
||||||
* found in the file LICENSE in this distribution or at
|
* found in the file LICENSE in this distribution or at
|
||||||
* http://www.rt-thread.org/license/LICENSE
|
* http://www.rt-thread.org/license/LICENSE
|
||||||
*
|
*
|
||||||
* Change Logs:
|
* Change Logs:
|
||||||
* Date Author Notes
|
* Date Author Notes
|
||||||
* 2012-04-25 weety first version
|
* 2012-04-25 weety first version
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef __I2C_H__
|
#ifndef __I2C_H__
|
||||||
#define __I2C_H__
|
#define __I2C_H__
|
||||||
|
|
||||||
#include <rtthread.h>
|
#include <rtthread.h>
|
||||||
|
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
extern "C" {
|
extern "C" {
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#define RT_I2C_WR 0x0000
|
#define RT_I2C_WR 0x0000
|
||||||
#define RT_I2C_RD (1u << 0)
|
#define RT_I2C_RD (1u << 0)
|
||||||
#define RT_I2C_ADDR_10BIT (1u << 2) /* this is a ten bit chip address */
|
#define RT_I2C_ADDR_10BIT (1u << 2) /* this is a ten bit chip address */
|
||||||
#define RT_I2C_NO_START (1u << 4)
|
#define RT_I2C_NO_START (1u << 4)
|
||||||
#define RT_I2C_IGNORE_NACK (1u << 5)
|
#define RT_I2C_IGNORE_NACK (1u << 5)
|
||||||
#define RT_I2C_NO_READ_ACK (1u << 6) /* when I2C reading, we do not ACK */
|
#define RT_I2C_NO_READ_ACK (1u << 6) /* when I2C reading, we do not ACK */
|
||||||
|
|
||||||
struct rt_i2c_msg
|
struct rt_i2c_msg
|
||||||
{
|
{
|
||||||
rt_uint16_t addr;
|
rt_uint16_t addr;
|
||||||
rt_uint16_t flags;
|
rt_uint16_t flags;
|
||||||
rt_uint16_t len;
|
rt_uint16_t len;
|
||||||
rt_uint8_t *buf;
|
rt_uint8_t *buf;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct rt_i2c_bus_device;
|
struct rt_i2c_bus_device;
|
||||||
|
|
||||||
struct rt_i2c_bus_device_ops
|
struct rt_i2c_bus_device_ops
|
||||||
{
|
{
|
||||||
rt_size_t (*master_xfer) (struct rt_i2c_bus_device *bus,
|
rt_size_t (*master_xfer)(struct rt_i2c_bus_device *bus,
|
||||||
struct rt_i2c_msg msgs[],
|
struct rt_i2c_msg msgs[],
|
||||||
rt_uint32_t num);
|
rt_uint32_t num);
|
||||||
rt_size_t (*slave_xfer) (struct rt_i2c_bus_device *bus,
|
rt_size_t (*slave_xfer)(struct rt_i2c_bus_device *bus,
|
||||||
struct rt_i2c_msg msgs[],
|
struct rt_i2c_msg msgs[],
|
||||||
rt_uint32_t num);
|
rt_uint32_t num);
|
||||||
rt_err_t (*i2c_bus_control) (struct rt_i2c_bus_device *bus,
|
rt_err_t (*i2c_bus_control)(struct rt_i2c_bus_device *bus,
|
||||||
rt_uint32_t,
|
rt_uint32_t,
|
||||||
rt_uint32_t);
|
rt_uint32_t);
|
||||||
};
|
};
|
||||||
|
|
||||||
/*for i2c bus driver*/
|
/*for i2c bus driver*/
|
||||||
struct rt_i2c_bus_device
|
struct rt_i2c_bus_device
|
||||||
{
|
{
|
||||||
struct rt_device parent;
|
struct rt_device parent;
|
||||||
const struct rt_i2c_bus_device_ops *ops;
|
const struct rt_i2c_bus_device_ops *ops;
|
||||||
rt_uint16_t flags;
|
rt_uint16_t flags;
|
||||||
rt_uint16_t addr;
|
rt_uint16_t addr;
|
||||||
struct rt_mutex lock;
|
struct rt_mutex lock;
|
||||||
rt_uint32_t timeout;
|
rt_uint32_t timeout;
|
||||||
rt_uint32_t retries;
|
rt_uint32_t retries;
|
||||||
void *priv;
|
void *priv;
|
||||||
};
|
};
|
||||||
|
|
||||||
#ifdef RT_I2C_DEBUG
|
#ifdef RT_I2C_DEBUG
|
||||||
#define i2c_dbg(fmt, ...) rt_kprintf(fmt, ##__VA_ARGS__)
|
#define i2c_dbg(fmt, ...) rt_kprintf(fmt, ##__VA_ARGS__)
|
||||||
#else
|
#else
|
||||||
#define i2c_dbg(fmt, ...)
|
#define i2c_dbg(fmt, ...)
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
rt_err_t rt_i2c_bus_device_register(struct rt_i2c_bus_device *bus,
|
rt_err_t rt_i2c_bus_device_register(struct rt_i2c_bus_device *bus,
|
||||||
const char *bus_name);
|
const char *bus_name);
|
||||||
struct rt_i2c_bus_device* rt_i2c_bus_device_find(const char *bus_name);
|
struct rt_i2c_bus_device *rt_i2c_bus_device_find(const char *bus_name);
|
||||||
rt_size_t rt_i2c_transfer(struct rt_i2c_bus_device *bus,
|
rt_size_t rt_i2c_transfer(struct rt_i2c_bus_device *bus,
|
||||||
struct rt_i2c_msg msgs[],
|
struct rt_i2c_msg msgs[],
|
||||||
rt_uint32_t num);
|
rt_uint32_t num);
|
||||||
rt_size_t rt_i2c_master_send(struct rt_i2c_bus_device *bus,
|
rt_size_t rt_i2c_master_send(struct rt_i2c_bus_device *bus,
|
||||||
rt_uint16_t addr,
|
rt_uint16_t addr,
|
||||||
rt_uint16_t flags,
|
rt_uint16_t flags,
|
||||||
const rt_uint8_t *buf,
|
const rt_uint8_t *buf,
|
||||||
rt_uint32_t count);
|
rt_uint32_t count);
|
||||||
rt_size_t rt_i2c_master_recv(struct rt_i2c_bus_device *bus,
|
rt_size_t rt_i2c_master_recv(struct rt_i2c_bus_device *bus,
|
||||||
rt_uint16_t addr,
|
rt_uint16_t addr,
|
||||||
rt_uint16_t flags,
|
rt_uint16_t flags,
|
||||||
rt_uint8_t *buf,
|
rt_uint8_t *buf,
|
||||||
rt_uint32_t count);
|
rt_uint32_t count);
|
||||||
rt_err_t rt_i2c_core_init(void);
|
rt_err_t rt_i2c_core_init(void);
|
||||||
|
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
@ -1,29 +1,42 @@
|
|||||||
#ifndef __I2C_DEV_H__
|
/*
|
||||||
#define __I2C_DEV_H__
|
* File : i2c_dev.h
|
||||||
|
* This file is part of RT-Thread RTOS
|
||||||
#include <rtthread.h>
|
* COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
||||||
|
*
|
||||||
#ifdef __cplusplus
|
* The license and distribution terms for this file may be
|
||||||
extern "C" {
|
* found in the file LICENSE in this distribution or at
|
||||||
#endif
|
* http://www.rt-thread.org/license/LICENSE
|
||||||
|
*
|
||||||
#define RT_I2C_DEV_CTRL_10BIT 0x20
|
* Change Logs:
|
||||||
#define RT_I2C_DEV_CTRL_ADDR 0x21
|
* Date Author Notes
|
||||||
#define RT_I2C_DEV_CTRL_TIMEOUT 0x22
|
* 2012-04-25 weety first version
|
||||||
#define RT_I2C_DEV_CTRL_RW 0x23
|
*/
|
||||||
|
|
||||||
struct rt_i2c_priv_data
|
#ifndef __I2C_DEV_H__
|
||||||
{
|
#define __I2C_DEV_H__
|
||||||
struct rt_i2c_msg *msgs;
|
|
||||||
rt_size_t number;
|
#include <rtthread.h>
|
||||||
};
|
|
||||||
|
#ifdef __cplusplus
|
||||||
rt_err_t rt_i2c_bus_device_device_init(struct rt_i2c_bus_device* bus,
|
extern "C" {
|
||||||
const char* name);
|
#endif
|
||||||
|
|
||||||
|
#define RT_I2C_DEV_CTRL_10BIT 0x20
|
||||||
#ifdef __cplusplus
|
#define RT_I2C_DEV_CTRL_ADDR 0x21
|
||||||
}
|
#define RT_I2C_DEV_CTRL_TIMEOUT 0x22
|
||||||
#endif
|
#define RT_I2C_DEV_CTRL_RW 0x23
|
||||||
|
|
||||||
#endif
|
struct rt_i2c_priv_data
|
||||||
|
{
|
||||||
|
struct rt_i2c_msg *msgs;
|
||||||
|
rt_size_t number;
|
||||||
|
};
|
||||||
|
|
||||||
|
rt_err_t rt_i2c_bus_device_device_init(struct rt_i2c_bus_device *bus,
|
||||||
|
const char *name);
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif
|
||||||
|
@ -1,78 +1,87 @@
|
|||||||
/*
|
/*
|
||||||
* File : mtd_core.c
|
* File : mtd_core.c
|
||||||
* This file is part of RT-Thread RTOS
|
* This file is part of RT-Thread RTOS
|
||||||
* COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
* COPYRIGHT (C) 2006 - 2012, RT-Thread Development Team
|
||||||
*
|
*
|
||||||
* The license and distribution terms for this file may be
|
* The license and distribution terms for this file may be
|
||||||
* found in the file LICENSE in this distribution or at
|
* found in the file LICENSE in this distribution or at
|
||||||
* http://www.rt-thread.org/license/LICENSE
|
* http://www.rt-thread.org/license/LICENSE
|
||||||
*
|
*
|
||||||
* Change Logs:
|
* Change Logs:
|
||||||
* Date Author Notes
|
* Date Author Notes
|
||||||
* 2011-12-05 Bernard the first version
|
* 2011-12-05 Bernard the first version
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* COPYRIGHT (C) 2012, Shanghai Real Thread
|
* COPYRIGHT (C) 2012, Shanghai Real Thread
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <drivers/mtd_nand.h>
|
#include <drivers/mtd_nand.h>
|
||||||
|
|
||||||
#ifdef RT_USING_MTD_NAND
|
#ifdef RT_USING_MTD_NAND
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* RT-Thread Generic Device Interface
|
* RT-Thread Generic Device Interface
|
||||||
*/
|
*/
|
||||||
static rt_err_t _mtd_init(rt_device_t dev)
|
static rt_err_t _mtd_init(rt_device_t dev)
|
||||||
{
|
{
|
||||||
return RT_EOK;
|
return RT_EOK;
|
||||||
}
|
|
||||||
|
|
||||||
static rt_err_t _mtd_open(rt_device_t dev, rt_uint16_t oflag)
|
|
||||||
{
|
|
||||||
return RT_EOK;
|
|
||||||
}
|
|
||||||
|
|
||||||
static rt_err_t _mtd_close(rt_device_t dev)
|
|
||||||
{
|
|
||||||
return RT_EOK;
|
|
||||||
}
|
|
||||||
|
|
||||||
static rt_size_t _mtd_read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size)
|
|
||||||
{
|
|
||||||
return size;
|
|
||||||
}
|
|
||||||
|
|
||||||
static rt_size_t _mtd_write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size)
|
|
||||||
{
|
|
||||||
return size;
|
|
||||||
}
|
|
||||||
|
|
||||||
static rt_err_t _mtd_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
|
||||||
{
|
|
||||||
return RT_EOK;
|
|
||||||
}
|
|
||||||
|
|
||||||
rt_err_t rt_mtd_nand_register_device(const char* name, struct rt_mtd_nand_device* device)
|
|
||||||
{
|
|
||||||
rt_device_t dev;
|
|
||||||
|
|
||||||
dev = RT_DEVICE(device);
|
|
||||||
RT_ASSERT(dev != RT_NULL);
|
|
||||||
|
|
||||||
/* set device class and generic device interface */
|
|
||||||
dev->type = RT_Device_Class_MTD;
|
|
||||||
dev->init = _mtd_init;
|
|
||||||
dev->open = _mtd_open;
|
|
||||||
dev->read = _mtd_read;
|
|
||||||
dev->write = _mtd_write;
|
|
||||||
dev->close = _mtd_close;
|
|
||||||
dev->control = _mtd_control;
|
|
||||||
|
|
||||||
dev->rx_indicate = RT_NULL;
|
|
||||||
dev->tx_complete = RT_NULL;
|
|
||||||
|
|
||||||
/* register to RT-Thread device system */
|
|
||||||
return rt_device_register(dev, name, RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_STANDALONE);
|
|
||||||
}
|
}
|
||||||
#endif
|
|
||||||
|
static rt_err_t _mtd_open(rt_device_t dev, rt_uint16_t oflag)
|
||||||
|
{
|
||||||
|
return RT_EOK;
|
||||||
|
}
|
||||||
|
|
||||||
|
static rt_err_t _mtd_close(rt_device_t dev)
|
||||||
|
{
|
||||||
|
return RT_EOK;
|
||||||
|
}
|
||||||
|
|
||||||
|
static rt_size_t _mtd_read(rt_device_t dev,
|
||||||
|
rt_off_t pos,
|
||||||
|
void *buffer,
|
||||||
|
rt_size_t size)
|
||||||
|
{
|
||||||
|
return size;
|
||||||
|
}
|
||||||
|
|
||||||
|
static rt_size_t _mtd_write(rt_device_t dev,
|
||||||
|
rt_off_t pos,
|
||||||
|
const void *buffer,
|
||||||
|
rt_size_t size)
|
||||||
|
{
|
||||||
|
return size;
|
||||||
|
}
|
||||||
|
|
||||||
|
static rt_err_t _mtd_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
||||||
|
{
|
||||||
|
return RT_EOK;
|
||||||
|
}
|
||||||
|
|
||||||
|
rt_err_t rt_mtd_nand_register_device(const char *name,
|
||||||
|
struct rt_mtd_nand_device *device)
|
||||||
|
{
|
||||||
|
rt_device_t dev;
|
||||||
|
|
||||||
|
dev = RT_DEVICE(device);
|
||||||
|
RT_ASSERT(dev != RT_NULL);
|
||||||
|
|
||||||
|
/* set device class and generic device interface */
|
||||||
|
dev->type = RT_Device_Class_MTD;
|
||||||
|
dev->init = _mtd_init;
|
||||||
|
dev->open = _mtd_open;
|
||||||
|
dev->read = _mtd_read;
|
||||||
|
dev->write = _mtd_write;
|
||||||
|
dev->close = _mtd_close;
|
||||||
|
dev->control = _mtd_control;
|
||||||
|
|
||||||
|
dev->rx_indicate = RT_NULL;
|
||||||
|
dev->tx_complete = RT_NULL;
|
||||||
|
|
||||||
|
/* register to RT-Thread device system */
|
||||||
|
return rt_device_register(dev, name, RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_STANDALONE);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
#endif
|
||||||
|
@ -1,74 +1,82 @@
|
|||||||
/*
|
/*
|
||||||
* File : mtd_nor.c
|
* File : mtd_nor.c
|
||||||
* This file is part of RT-Thread RTOS
|
* This file is part of RT-Thread RTOS
|
||||||
* COPYRIGHT (C) 2012, Shanghai Real-Thread Technology Co., Ltd
|
* COPYRIGHT (C) 2012, Shanghai Real-Thread Technology Co., Ltd
|
||||||
*
|
*
|
||||||
* The license and distribution terms for this file may be
|
* The license and distribution terms for this file may be
|
||||||
* found in the file LICENSE in this distribution or at
|
* found in the file LICENSE in this distribution or at
|
||||||
* http://www.rt-thread.org/license/LICENSE
|
* http://www.rt-thread.org/license/LICENSE
|
||||||
*
|
*
|
||||||
* Change Logs:
|
* Change Logs:
|
||||||
* Date Author Notes
|
* Date Author Notes
|
||||||
* 2012-5-30 Bernard the first version
|
* 2012-5-30 Bernard the first version
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <drivers/mtd_nor.h>
|
#include <drivers/mtd_nor.h>
|
||||||
|
|
||||||
#ifdef RT_USING_MTD_NOR
|
#ifdef RT_USING_MTD_NOR
|
||||||
|
|
||||||
/*
|
/**
|
||||||
* RT-Thread Generic Device Interface
|
* RT-Thread Generic Device Interface
|
||||||
*/
|
*/
|
||||||
static rt_err_t _mtd_init(rt_device_t dev)
|
static rt_err_t _mtd_init(rt_device_t dev)
|
||||||
{
|
{
|
||||||
return RT_EOK;
|
return RT_EOK;
|
||||||
}
|
}
|
||||||
|
|
||||||
static rt_err_t _mtd_open(rt_device_t dev, rt_uint16_t oflag)
|
static rt_err_t _mtd_open(rt_device_t dev, rt_uint16_t oflag)
|
||||||
{
|
{
|
||||||
return RT_EOK;
|
return RT_EOK;
|
||||||
}
|
}
|
||||||
|
|
||||||
static rt_err_t _mtd_close(rt_device_t dev)
|
static rt_err_t _mtd_close(rt_device_t dev)
|
||||||
{
|
{
|
||||||
return RT_EOK;
|
return RT_EOK;
|
||||||
}
|
}
|
||||||
|
|
||||||
static rt_size_t _mtd_read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size)
|
static rt_size_t _mtd_read(rt_device_t dev,
|
||||||
{
|
rt_off_t pos,
|
||||||
return size;
|
void *buffer,
|
||||||
}
|
rt_size_t size)
|
||||||
|
{
|
||||||
static rt_size_t _mtd_write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size)
|
return size;
|
||||||
{
|
}
|
||||||
return size;
|
|
||||||
}
|
static rt_size_t _mtd_write(rt_device_t dev,
|
||||||
|
rt_off_t pos,
|
||||||
static rt_err_t _mtd_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
const void *buffer,
|
||||||
{
|
rt_size_t size)
|
||||||
return RT_EOK;
|
{
|
||||||
}
|
return size;
|
||||||
|
}
|
||||||
rt_err_t rt_mtd_nor_register_device(const char* name, struct rt_mtd_nor_device* device)
|
|
||||||
{
|
static rt_err_t _mtd_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
||||||
rt_device_t dev;
|
{
|
||||||
|
return RT_EOK;
|
||||||
dev = RT_DEVICE(device);
|
}
|
||||||
RT_ASSERT(dev != RT_NULL);
|
|
||||||
|
rt_err_t rt_mtd_nor_register_device(const char *name,
|
||||||
/* set device class and generic device interface */
|
struct rt_mtd_nor_device *device)
|
||||||
dev->type = RT_Device_Class_MTD;
|
{
|
||||||
dev->init = _mtd_init;
|
rt_device_t dev;
|
||||||
dev->open = _mtd_open;
|
|
||||||
dev->read = _mtd_read;
|
dev = RT_DEVICE(device);
|
||||||
dev->write = _mtd_write;
|
RT_ASSERT(dev != RT_NULL);
|
||||||
dev->close = _mtd_close;
|
|
||||||
dev->control = _mtd_control;
|
/* set device class and generic device interface */
|
||||||
|
dev->type = RT_Device_Class_MTD;
|
||||||
dev->rx_indicate = RT_NULL;
|
dev->init = _mtd_init;
|
||||||
dev->tx_complete = RT_NULL;
|
dev->open = _mtd_open;
|
||||||
|
dev->read = _mtd_read;
|
||||||
/* register to RT-Thread device system */
|
dev->write = _mtd_write;
|
||||||
return rt_device_register(dev, name, RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_STANDALONE);
|
dev->close = _mtd_close;
|
||||||
}
|
dev->control = _mtd_control;
|
||||||
#endif
|
|
||||||
|
dev->rx_indicate = RT_NULL;
|
||||||
|
dev->tx_complete = RT_NULL;
|
||||||
|
|
||||||
|
/* register to RT-Thread device system */
|
||||||
|
return rt_device_register(dev, name, RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_STANDALONE);
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
File diff suppressed because it is too large
Load Diff
@ -89,6 +89,7 @@ rt_err_t rt_completion_wait(struct rt_completion *completion,
|
|||||||
|
|
||||||
__exit:
|
__exit:
|
||||||
rt_hw_interrupt_enable(level);
|
rt_hw_interrupt_enable(level);
|
||||||
|
|
||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -1,205 +1,205 @@
|
|||||||
/*
|
/*
|
||||||
* File : pipe.c
|
* File : pipe.c
|
||||||
* This file is part of RT-Thread RTOS
|
* This file is part of RT-Thread RTOS
|
||||||
* COPYRIGHT (C) 2012, RT-Thread Development Team
|
* COPYRIGHT (C) 2012, RT-Thread Development Team
|
||||||
*
|
*
|
||||||
* The license and distribution terms for this file may be
|
* The license and distribution terms for this file may be
|
||||||
* found in the file LICENSE in this distribution or at
|
* found in the file LICENSE in this distribution or at
|
||||||
* http://www.rt-thread.org/license/LICENSE
|
* http://www.rt-thread.org/license/LICENSE
|
||||||
*
|
*
|
||||||
* Change Logs:
|
* Change Logs:
|
||||||
* Date Author Notes
|
* Date Author Notes
|
||||||
* 2012-09-30 Bernard first version.
|
* 2012-09-30 Bernard first version.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <rthw.h>
|
#include <rthw.h>
|
||||||
#include <rtthread.h>
|
#include <rtthread.h>
|
||||||
#include <rtdevice.h>
|
#include <rtdevice.h>
|
||||||
|
|
||||||
static rt_size_t rt_pipe_read(rt_device_t dev,
|
static rt_size_t rt_pipe_read(rt_device_t dev,
|
||||||
rt_off_t pos,
|
rt_off_t pos,
|
||||||
void *buffer,
|
void *buffer,
|
||||||
rt_size_t size)
|
rt_size_t size)
|
||||||
{
|
{
|
||||||
rt_uint32_t level;
|
rt_uint32_t level;
|
||||||
rt_thread_t thread;
|
rt_thread_t thread;
|
||||||
struct rt_pipe_device *pipe;
|
struct rt_pipe_device *pipe;
|
||||||
rt_size_t read_nbytes;
|
rt_size_t read_nbytes;
|
||||||
|
|
||||||
pipe = PIPE_DEVICE(dev);
|
pipe = PIPE_DEVICE(dev);
|
||||||
RT_ASSERT(pipe != RT_NULL);
|
RT_ASSERT(pipe != RT_NULL);
|
||||||
|
|
||||||
thread = rt_thread_self();
|
thread = rt_thread_self();
|
||||||
|
|
||||||
/* current context checking */
|
/* current context checking */
|
||||||
RT_DEBUG_NOT_IN_INTERRUPT;
|
RT_DEBUG_NOT_IN_INTERRUPT;
|
||||||
|
|
||||||
do
|
do
|
||||||
{
|
{
|
||||||
level = rt_hw_interrupt_disable();
|
level = rt_hw_interrupt_disable();
|
||||||
read_nbytes = rt_ringbuffer_get(&(pipe->ringbuffer), buffer, size);
|
read_nbytes = rt_ringbuffer_get(&(pipe->ringbuffer), buffer, size);
|
||||||
if (read_nbytes == 0)
|
if (read_nbytes == 0)
|
||||||
{
|
{
|
||||||
rt_thread_suspend(thread);
|
rt_thread_suspend(thread);
|
||||||
/* waiting on suspended read list */
|
/* waiting on suspended read list */
|
||||||
rt_list_insert_before(&(pipe->suspended_read_list), &(thread->tlist));
|
rt_list_insert_before(&(pipe->suspended_read_list), &(thread->tlist));
|
||||||
rt_hw_interrupt_enable(level);
|
rt_hw_interrupt_enable(level);
|
||||||
|
|
||||||
rt_schedule();
|
rt_schedule();
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
if (!rt_list_isempty(&pipe->suspended_write_list))
|
if (!rt_list_isempty(&pipe->suspended_write_list))
|
||||||
{
|
{
|
||||||
/* get suspended thread */
|
/* get suspended thread */
|
||||||
thread = rt_list_entry(pipe->suspended_write_list.next,
|
thread = rt_list_entry(pipe->suspended_write_list.next,
|
||||||
struct rt_thread, tlist);
|
struct rt_thread, tlist);
|
||||||
|
|
||||||
/* resume the write thread */
|
/* resume the write thread */
|
||||||
rt_thread_resume(thread);
|
rt_thread_resume(thread);
|
||||||
rt_hw_interrupt_enable(level);
|
rt_hw_interrupt_enable(level);
|
||||||
|
|
||||||
rt_schedule();
|
rt_schedule();
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
rt_hw_interrupt_enable(level);
|
rt_hw_interrupt_enable(level);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
} while (read_nbytes == 0);
|
} while (read_nbytes == 0);
|
||||||
|
|
||||||
return read_nbytes;
|
return read_nbytes;
|
||||||
}
|
}
|
||||||
|
|
||||||
struct rt_pipe_device *_pipe = RT_NULL;
|
struct rt_pipe_device *_pipe = RT_NULL;
|
||||||
static rt_size_t rt_pipe_write(rt_device_t dev,
|
static rt_size_t rt_pipe_write(rt_device_t dev,
|
||||||
rt_off_t pos,
|
rt_off_t pos,
|
||||||
const void *buffer,
|
const void *buffer,
|
||||||
rt_size_t size)
|
rt_size_t size)
|
||||||
{
|
{
|
||||||
rt_uint32_t level;
|
rt_uint32_t level;
|
||||||
rt_thread_t thread;
|
rt_thread_t thread;
|
||||||
struct rt_pipe_device *pipe;
|
struct rt_pipe_device *pipe;
|
||||||
rt_size_t write_nbytes;
|
rt_size_t write_nbytes;
|
||||||
|
|
||||||
pipe = PIPE_DEVICE(dev);
|
pipe = PIPE_DEVICE(dev);
|
||||||
RT_ASSERT(pipe != RT_NULL);
|
RT_ASSERT(pipe != RT_NULL);
|
||||||
if (_pipe == RT_NULL)
|
if (_pipe == RT_NULL)
|
||||||
_pipe = pipe;
|
_pipe = pipe;
|
||||||
|
|
||||||
thread = rt_thread_self();
|
thread = rt_thread_self();
|
||||||
|
|
||||||
/* current context checking */
|
/* current context checking */
|
||||||
RT_DEBUG_NOT_IN_INTERRUPT;
|
RT_DEBUG_NOT_IN_INTERRUPT;
|
||||||
|
|
||||||
do
|
do
|
||||||
{
|
{
|
||||||
level = rt_hw_interrupt_disable();
|
level = rt_hw_interrupt_disable();
|
||||||
write_nbytes = rt_ringbuffer_put(&(pipe->ringbuffer), buffer, size);
|
write_nbytes = rt_ringbuffer_put(&(pipe->ringbuffer), buffer, size);
|
||||||
if (write_nbytes == 0)
|
if (write_nbytes == 0)
|
||||||
{
|
{
|
||||||
/* pipe full, waiting on suspended write list */
|
/* pipe full, waiting on suspended write list */
|
||||||
rt_thread_suspend(thread);
|
rt_thread_suspend(thread);
|
||||||
/* waiting on suspended read list */
|
/* waiting on suspended read list */
|
||||||
rt_list_insert_before(&(pipe->suspended_write_list), &(thread->tlist));
|
rt_list_insert_before(&(pipe->suspended_write_list), &(thread->tlist));
|
||||||
rt_hw_interrupt_enable(level);
|
rt_hw_interrupt_enable(level);
|
||||||
|
|
||||||
rt_schedule();
|
rt_schedule();
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
if (!rt_list_isempty(&pipe->suspended_read_list))
|
if (!rt_list_isempty(&pipe->suspended_read_list))
|
||||||
{
|
{
|
||||||
/* get suspended thread */
|
/* get suspended thread */
|
||||||
thread = rt_list_entry(pipe->suspended_read_list.next,
|
thread = rt_list_entry(pipe->suspended_read_list.next,
|
||||||
struct rt_thread, tlist);
|
struct rt_thread, tlist);
|
||||||
|
|
||||||
/* resume the read thread */
|
/* resume the read thread */
|
||||||
rt_thread_resume(thread);
|
rt_thread_resume(thread);
|
||||||
rt_hw_interrupt_enable(level);
|
rt_hw_interrupt_enable(level);
|
||||||
|
|
||||||
rt_schedule();
|
rt_schedule();
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
rt_hw_interrupt_enable(level);
|
rt_hw_interrupt_enable(level);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}while (write_nbytes == 0);
|
}while (write_nbytes == 0);
|
||||||
|
|
||||||
return write_nbytes;
|
return write_nbytes;
|
||||||
}
|
}
|
||||||
|
|
||||||
static rt_err_t rt_pipe_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
static rt_err_t rt_pipe_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
||||||
{
|
{
|
||||||
return RT_EOK;
|
return RT_EOK;
|
||||||
}
|
}
|
||||||
|
|
||||||
rt_err_t rt_pipe_create(const char *name, rt_size_t size)
|
rt_err_t rt_pipe_create(const char *name, rt_size_t size)
|
||||||
{
|
{
|
||||||
rt_err_t result = RT_EOK;
|
rt_err_t result = RT_EOK;
|
||||||
rt_uint8_t *rb_memptr = RT_NULL;
|
rt_uint8_t *rb_memptr = RT_NULL;
|
||||||
struct rt_pipe_device *pipe = RT_NULL;
|
struct rt_pipe_device *pipe = RT_NULL;
|
||||||
|
|
||||||
/* get aligned size */
|
/* get aligned size */
|
||||||
size = RT_ALIGN(size, RT_ALIGN_SIZE);
|
size = RT_ALIGN(size, RT_ALIGN_SIZE);
|
||||||
pipe = (struct rt_pipe_device *)rt_calloc(1, sizeof(struct rt_pipe_device));
|
pipe = (struct rt_pipe_device *)rt_calloc(1, sizeof(struct rt_pipe_device));
|
||||||
if (pipe != RT_NULL)
|
if (pipe != RT_NULL)
|
||||||
{
|
{
|
||||||
/* create ring buffer of pipe */
|
/* create ring buffer of pipe */
|
||||||
rb_memptr = rt_malloc(size);
|
rb_memptr = rt_malloc(size);
|
||||||
if (rb_memptr == RT_NULL)
|
if (rb_memptr == RT_NULL)
|
||||||
{
|
{
|
||||||
result = -RT_ENOMEM;
|
result = -RT_ENOMEM;
|
||||||
goto __exit;
|
goto __exit;
|
||||||
}
|
}
|
||||||
/* initialize suspended list */
|
/* initialize suspended list */
|
||||||
rt_list_init(&pipe->suspended_read_list);
|
rt_list_init(&pipe->suspended_read_list);
|
||||||
rt_list_init(&pipe->suspended_write_list);
|
rt_list_init(&pipe->suspended_write_list);
|
||||||
|
|
||||||
/* initialize ring buffer */
|
/* initialize ring buffer */
|
||||||
rt_ringbuffer_init(&pipe->ringbuffer, rb_memptr, size);
|
rt_ringbuffer_init(&pipe->ringbuffer, rb_memptr, size);
|
||||||
|
|
||||||
/* create device */
|
/* create device */
|
||||||
pipe->parent.type = RT_Device_Class_Char;
|
pipe->parent.type = RT_Device_Class_Char;
|
||||||
pipe->parent.init = RT_NULL;
|
pipe->parent.init = RT_NULL;
|
||||||
pipe->parent.open = RT_NULL;
|
pipe->parent.open = RT_NULL;
|
||||||
pipe->parent.close = RT_NULL;
|
pipe->parent.close = RT_NULL;
|
||||||
pipe->parent.read = rt_pipe_read;
|
pipe->parent.read = rt_pipe_read;
|
||||||
pipe->parent.write = rt_pipe_write;
|
pipe->parent.write = rt_pipe_write;
|
||||||
pipe->parent.control = rt_pipe_control;
|
pipe->parent.control = rt_pipe_control;
|
||||||
|
|
||||||
return rt_device_register(&(pipe->parent), name, RT_DEVICE_FLAG_RDWR);
|
return rt_device_register(&(pipe->parent), name, RT_DEVICE_FLAG_RDWR);
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
result = -RT_ENOMEM;
|
result = -RT_ENOMEM;
|
||||||
}
|
}
|
||||||
|
|
||||||
__exit:
|
__exit:
|
||||||
if (pipe != RT_NULL)
|
if (pipe != RT_NULL)
|
||||||
rt_free(pipe);
|
rt_free(pipe);
|
||||||
if (rb_memptr != RT_NULL)
|
if (rb_memptr != RT_NULL)
|
||||||
rt_free(rb_memptr);
|
rt_free(rb_memptr);
|
||||||
|
|
||||||
return result;
|
return result;
|
||||||
}
|
}
|
||||||
RTM_EXPORT(rt_pipe_create);
|
RTM_EXPORT(rt_pipe_create);
|
||||||
|
|
||||||
void rt_pipe_destroy(struct rt_pipe_device *pipe)
|
void rt_pipe_destroy(struct rt_pipe_device *pipe)
|
||||||
{
|
{
|
||||||
if (pipe == RT_NULL)
|
if (pipe == RT_NULL)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
/* un-register pipe device */
|
/* un-register pipe device */
|
||||||
rt_device_unregister(&(pipe->parent));
|
rt_device_unregister(&(pipe->parent));
|
||||||
|
|
||||||
/* release memory */
|
/* release memory */
|
||||||
rt_free(pipe->ringbuffer.buffer_ptr);
|
rt_free(pipe->ringbuffer.buffer_ptr);
|
||||||
rt_free(pipe);
|
rt_free(pipe);
|
||||||
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
RTM_EXPORT(rt_pipe_destroy);
|
RTM_EXPORT(rt_pipe_destroy);
|
||||||
|
@ -1,155 +1,161 @@
|
|||||||
/*
|
/*
|
||||||
* File : ringbuffer.c
|
* File : ringbuffer.c
|
||||||
* This file is part of RT-Thread RTOS
|
* This file is part of RT-Thread RTOS
|
||||||
* COPYRIGHT (C) 2012, RT-Thread Development Team
|
* COPYRIGHT (C) 2012, RT-Thread Development Team
|
||||||
*
|
*
|
||||||
* The license and distribution terms for this file may be
|
* The license and distribution terms for this file may be
|
||||||
* found in the file LICENSE in this distribution or at
|
* found in the file LICENSE in this distribution or at
|
||||||
* http://www.rt-thread.org/license/LICENSE
|
* http://www.rt-thread.org/license/LICENSE
|
||||||
*
|
*
|
||||||
* Change Logs:
|
* Change Logs:
|
||||||
* Date Author Notes
|
* Date Author Notes
|
||||||
* 2012-09-30 Bernard first version.
|
* 2012-09-30 Bernard first version.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <rtthread.h>
|
#include <rtthread.h>
|
||||||
#include <rtdevice.h>
|
#include <rtdevice.h>
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
|
|
||||||
void rt_ringbuffer_init(struct rt_ringbuffer *rb,
|
void rt_ringbuffer_init(struct rt_ringbuffer *rb,
|
||||||
rt_uint8_t *pool,
|
rt_uint8_t *pool,
|
||||||
rt_uint16_t size)
|
rt_uint16_t size)
|
||||||
{
|
{
|
||||||
RT_ASSERT(rb != RT_NULL);
|
RT_ASSERT(rb != RT_NULL);
|
||||||
|
|
||||||
/* initialize read and write index */
|
/* initialize read and write index */
|
||||||
rb->read_index = rb->write_index = 0;
|
rb->read_index = rb->write_index = 0;
|
||||||
|
|
||||||
/* set buffer pool and size */
|
/* set buffer pool and size */
|
||||||
rb->buffer_ptr = pool;
|
rb->buffer_ptr = pool;
|
||||||
rb->buffer_size = RT_ALIGN_DOWN(size, RT_ALIGN_SIZE);
|
rb->buffer_size = RT_ALIGN_DOWN(size, RT_ALIGN_SIZE);
|
||||||
}
|
}
|
||||||
RTM_EXPORT(rt_ringbuffer_init);
|
RTM_EXPORT(rt_ringbuffer_init);
|
||||||
|
|
||||||
rt_size_t rt_ringbuffer_put(struct rt_ringbuffer *rb,
|
rt_size_t rt_ringbuffer_put(struct rt_ringbuffer *rb,
|
||||||
const rt_uint8_t *ptr,
|
const rt_uint8_t *ptr,
|
||||||
rt_uint16_t length)
|
rt_uint16_t length)
|
||||||
{
|
{
|
||||||
rt_uint16_t size;
|
rt_uint16_t size;
|
||||||
rt_uint16_t mask;
|
rt_uint16_t mask;
|
||||||
rt_uint16_t write_position;
|
rt_uint16_t write_position;
|
||||||
|
|
||||||
RT_ASSERT(rb != RT_NULL);
|
RT_ASSERT(rb != RT_NULL);
|
||||||
|
|
||||||
mask = rb->buffer_size - 1;
|
mask = rb->buffer_size - 1;
|
||||||
/* whether has enough space */
|
/* whether has enough space */
|
||||||
size = rb->buffer_size - (rb->write_index - rb->read_index);
|
size = rb->buffer_size - (rb->write_index - rb->read_index);
|
||||||
|
|
||||||
/* no space */
|
/* no space */
|
||||||
if (size == 0) return 0;
|
if (size == 0)
|
||||||
/* drop some data */
|
return 0;
|
||||||
if (size < length) length = size;
|
/* drop some data */
|
||||||
|
if (size < length)
|
||||||
write_position = (rb->write_index & mask);
|
length = size;
|
||||||
if (rb->buffer_size - write_position> length)
|
|
||||||
{
|
write_position = (rb->write_index & mask);
|
||||||
/* read_index - write_index = empty space */
|
if (rb->buffer_size - write_position> length)
|
||||||
memcpy(&rb->buffer_ptr[write_position], ptr, length);
|
{
|
||||||
}
|
/* read_index - write_index = empty space */
|
||||||
else
|
memcpy(&rb->buffer_ptr[write_position], ptr, length);
|
||||||
{
|
}
|
||||||
memcpy(&rb->buffer_ptr[write_position], ptr,
|
else
|
||||||
rb->buffer_size - write_position);
|
{
|
||||||
memcpy(&rb->buffer_ptr[0], &ptr[rb->buffer_size - write_position],
|
memcpy(&rb->buffer_ptr[write_position], ptr,
|
||||||
length - (rb->buffer_size - write_position));
|
rb->buffer_size - write_position);
|
||||||
}
|
memcpy(&rb->buffer_ptr[0], &ptr[rb->buffer_size - write_position],
|
||||||
rb->write_index += length;
|
length - (rb->buffer_size - write_position));
|
||||||
|
}
|
||||||
return length;
|
rb->write_index += length;
|
||||||
}
|
|
||||||
RTM_EXPORT(rt_ringbuffer_put);
|
return length;
|
||||||
|
}
|
||||||
/**
|
RTM_EXPORT(rt_ringbuffer_put);
|
||||||
* put a character into ring buffer
|
|
||||||
*/
|
/**
|
||||||
rt_size_t rt_ringbuffer_putchar(struct rt_ringbuffer* rb, const rt_uint8_t ch)
|
* put a character into ring buffer
|
||||||
{
|
*/
|
||||||
rt_uint16_t mask;
|
rt_size_t rt_ringbuffer_putchar(struct rt_ringbuffer *rb, const rt_uint8_t ch)
|
||||||
|
{
|
||||||
RT_ASSERT(rb != RT_NULL);
|
rt_uint16_t mask;
|
||||||
/* whether has enough space */
|
|
||||||
mask = rb->buffer_size - 1;
|
RT_ASSERT(rb != RT_NULL);
|
||||||
|
/* whether has enough space */
|
||||||
/* whether has enough space */
|
mask = rb->buffer_size - 1;
|
||||||
if (rb->write_index - rb->read_index == rb->buffer_size) return 0;
|
|
||||||
|
/* whether has enough space */
|
||||||
/* put character */
|
if (rb->write_index - rb->read_index == rb->buffer_size)
|
||||||
rb->buffer_ptr[rb->write_index & mask] = ch;
|
return 0;
|
||||||
rb->write_index += 1;
|
|
||||||
|
/* put character */
|
||||||
return 1;
|
rb->buffer_ptr[rb->write_index & mask] = ch;
|
||||||
}
|
rb->write_index += 1;
|
||||||
RTM_EXPORT(rt_ringbuffer_putchar);
|
|
||||||
|
return 1;
|
||||||
/**
|
}
|
||||||
* get data from ring buffer
|
RTM_EXPORT(rt_ringbuffer_putchar);
|
||||||
*/
|
|
||||||
rt_size_t rt_ringbuffer_get(struct rt_ringbuffer *rb,
|
/**
|
||||||
rt_uint8_t *ptr,
|
* get data from ring buffer
|
||||||
rt_uint16_t length)
|
*/
|
||||||
{
|
rt_size_t rt_ringbuffer_get(struct rt_ringbuffer *rb,
|
||||||
rt_size_t size;
|
rt_uint8_t *ptr,
|
||||||
rt_uint16_t mask;
|
rt_uint16_t length)
|
||||||
rt_uint16_t read_position;
|
{
|
||||||
|
rt_size_t size;
|
||||||
RT_ASSERT(rb != RT_NULL);
|
rt_uint16_t mask;
|
||||||
/* whether has enough data */
|
rt_uint16_t read_position;
|
||||||
mask = rb->buffer_size - 1;
|
|
||||||
size = rb->write_index - rb->read_index;
|
RT_ASSERT(rb != RT_NULL);
|
||||||
|
/* whether has enough data */
|
||||||
/* no data */
|
mask = rb->buffer_size - 1;
|
||||||
if (size == 0) return 0;
|
size = rb->write_index - rb->read_index;
|
||||||
/* less data */
|
|
||||||
if (size < length) length = size;
|
/* no data */
|
||||||
|
if (size == 0)
|
||||||
read_position = rb->read_index & mask;
|
return 0;
|
||||||
if (rb->buffer_size - read_position >= length)
|
/* less data */
|
||||||
{
|
if (size < length)
|
||||||
/* copy all of data */
|
length = size;
|
||||||
memcpy(ptr, &rb->buffer_ptr[read_position], length);
|
|
||||||
}
|
read_position = rb->read_index & mask;
|
||||||
else
|
if (rb->buffer_size - read_position >= length)
|
||||||
{
|
{
|
||||||
/* copy first and second */
|
/* copy all of data */
|
||||||
memcpy(ptr, &rb->buffer_ptr[read_position],
|
memcpy(ptr, &rb->buffer_ptr[read_position], length);
|
||||||
rb->buffer_size - read_position);
|
}
|
||||||
memcpy(&ptr[rb->buffer_size - read_position], &rb->buffer_ptr[0],
|
else
|
||||||
length - rb->buffer_size + read_position);
|
{
|
||||||
}
|
/* copy first and second */
|
||||||
rb->read_index += length;
|
memcpy(ptr, &rb->buffer_ptr[read_position],
|
||||||
|
rb->buffer_size - read_position);
|
||||||
return length;
|
memcpy(&ptr[rb->buffer_size - read_position], &rb->buffer_ptr[0],
|
||||||
}
|
length - rb->buffer_size + read_position);
|
||||||
RTM_EXPORT(rt_ringbuffer_get);
|
}
|
||||||
|
rb->read_index += length;
|
||||||
/**
|
|
||||||
* get a character from a ringbuffer
|
return length;
|
||||||
*/
|
}
|
||||||
rt_size_t rt_ringbuffer_getchar(struct rt_ringbuffer *rb, rt_uint8_t *ch)
|
RTM_EXPORT(rt_ringbuffer_get);
|
||||||
{
|
|
||||||
rt_uint16_t mask;
|
/**
|
||||||
|
* get a character from a ringbuffer
|
||||||
RT_ASSERT(rb != RT_NULL);
|
*/
|
||||||
|
rt_size_t rt_ringbuffer_getchar(struct rt_ringbuffer *rb, rt_uint8_t *ch)
|
||||||
/* ringbuffer is empty */
|
{
|
||||||
if (rb->read_index == rb->write_index) return 0;
|
rt_uint16_t mask;
|
||||||
|
|
||||||
mask = rb->buffer_size - 1;
|
RT_ASSERT(rb != RT_NULL);
|
||||||
|
|
||||||
/* put character */
|
/* ringbuffer is empty */
|
||||||
*ch = rb->buffer_ptr[rb->read_index & mask];
|
if (rb->read_index == rb->write_index)
|
||||||
rb->read_index += 1;
|
return 0;
|
||||||
|
|
||||||
return 1;
|
mask = rb->buffer_size - 1;
|
||||||
}
|
|
||||||
RTM_EXPORT(rt_ringbuffer_getchar);
|
/* put character */
|
||||||
|
*ch = rb->buffer_ptr[rb->read_index & mask];
|
||||||
|
rb->read_index += 1;
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
RTM_EXPORT(rt_ringbuffer_getchar);
|
||||||
|
Loading…
x
Reference in New Issue
Block a user