diff options
Diffstat (limited to 'commandline/i2cset.c')
-rw-r--r-- | commandline/i2cset.c | 11 |
1 files changed, 9 insertions, 2 deletions
diff --git a/commandline/i2cset.c b/commandline/i2cset.c index 5b2662c..2d7567f 100644 --- a/commandline/i2cset.c +++ b/commandline/i2cset.c @@ -10,8 +10,6 @@ int main(int argc, char **argv) char *conv_err; i2c_getopt(argc, argv); - i2c_init(); - i2c_start(); if (argc < 3) { fputs("Usage: i2cset <address> <data ...>", stderr); @@ -25,8 +23,13 @@ int main(int argc, char **argv) return 2; } + i2c_init(); + i2c_start(); + if (!i2c_tx_byte(address << 1)) { fprintf(stderr, "Received NAK from slave 0x%02x, aborting\n", address); + i2c_stop(); + i2c_deinit(); return 3; } @@ -34,10 +37,14 @@ int main(int argc, char **argv) cmdbuf = strtol(argv[i], &conv_err, 0); if (conv_err && *conv_err) { fprintf(stderr, "write command: conversion error at '%s'\n", conv_err); + i2c_stop(); + i2c_deinit(); return 2; } if (!i2c_tx_byte(cmdbuf)) { fprintf(stderr, "Received NAK after byte %d (0x%02x)\n", i-1, cmdbuf); + i2c_stop(); + i2c_deinit(); return 4; } } |