dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

Implement a simple byte loopback server on I2C for more testing.

This commit is contained in:
px4dev 2013-01-09 21:39:54 -08:00
parent 2fb820fabd
commit 3cea0959b7
2 changed files with 11 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
apps/px4io/i2c.c
View File

@ -78,7 +78,6 @@ static DMA_HANDLE tx_dma;
uint8_t rx_buf[64];
unsigned rx_len;
uint8_t tx_buf[64];
unsigned tx_len;
enum {
DIR_NONE = 0,
@ -210,6 +209,9 @@ i2c_rx_complete(DMA_HANDLE handle, uint8_t status, void *arg)
{
rx_len = sizeof(rx_buf) - stm32_dmaresidual(rx_dma);
for (unsigned i = 0; i < rx_len; i++)
tx_buf[i] = rx_buf[i] + 1;
/* XXX handle reception */
i2c_rx_setup();
}
@ -217,7 +219,6 @@ i2c_rx_complete(DMA_HANDLE handle, uint8_t status, void *arg)
static void
i2c_tx_setup(void)
{
tx_len = 0;
stm32_dmasetup(tx_dma, (uintptr_t)&rDR, (uintptr_t)&tx_buf[0], sizeof(tx_buf),
DMA_CCR_DIR |
DMA_CCR_MINC |
@ -229,9 +230,7 @@ i2c_tx_setup(void)
static void
i2c_tx_complete(DMA_HANDLE handle, uint8_t status, void *arg)
{
tx_len = sizeof(tx_buf) - stm32_dmaresidual(tx_dma);
/* XXX handle reception */
/* XXX handle transmit-done */
i2c_tx_setup();
}

9
apps/systemcmds/i2c/i2c.c
View File

@ -84,8 +84,13 @@ int i2c_main(int argc, char *argv[])
int ret = transfer(PX4_I2C_OBDEV_PX4IO, (uint8_t *)&val, sizeof(val), NULL, 0);
if (ret)
errx(1, "transfer failed");
exit(0);
errx(1, "send failed - %d", ret);
ret = transfer(PX4_I2C_OBDEV_PX4IO, NULL, 0, (uint8_t *)&val, sizeof(val));
if (ret)
errx(1, "recive failed - %d", ret);
errx(0, "got 0x%08x", val);
}
static int