michaelh/zephyr
1
0
Fork 0
Code Releases Activity

samples: i2c_scanner: support output like i2c_detect

Browse source 
Supports output in the same format as the i2c_detect command.

Signed-off-by: Kwon Tae-young <tykwon@m2i.co.kr>
This commit is contained in:
Kwon Tae-young 2019-12-13 10:16:35 +09:00 • committed by Carles Cufí
commit 94e419c624
1 changed files with 25 additions and 13 deletions
Download patch file Download diff file Expand all files Collapse all files

26
samples/drivers/i2c_scanner/src/main.c
View file

@ -23,9 +23,9 @@
void main(void)
{
struct device *i2c_dev;
u8_t cnt = 0;
u8_t cnt = 0, first = 0x04, last = 0x77;
printk("Starting i2c scanner...\n");
printk("Starting i2c scanner...\n\n");
i2c_dev = device_get_binding(I2C_DEV);
if (!i2c_dev) {
@ -33,7 +33,15 @@ void main(void)
return;
}
for (u8_t i = 4; i <= 0x77; i++) {
printk(" 0 1 2 3 4 5 6 7 8 9 a b c d e f\n");
for (u8_t i = 0; i <= last; i += 16) {
printk("%02x: ", i);
for (u8_t j = 0; j < 16; j++) {
if (i + j < first || i + j > last) {
printk(" ");
continue;
}
struct i2c_msg msgs[1];
u8_t dst;
@ -41,12 +49,16 @@ void main(void)
msgs[0].buf = &dst;
msgs[0].len = 0U;
msgs[0].flags = I2C_MSG_WRITE | I2C_MSG_STOP;
if (i2c_transfer(i2c_dev, &msgs[0], 1, i) == 0) {
printk("0x%2x FOUND\n", i);
if (i2c_transfer(i2c_dev, &msgs[0], 1, i + j) == 0) {
printk("%02x ", i + j);
++cnt;
} else {
printk("-- ");
}
}
printk("%u devices found on %s\n", cnt, I2C_DEV);
printk("\n");
}
printk("\n%u devices found on %s\n", cnt, I2C_DEV);
}