cmd_i2c.c: reworked subcommand handling