Function i2c_detect

i2c_tools/i2c_tools.cpp:16–81

\******************************************************************************************/

std::string i2c_detect(i2c_smbus_interface * bus, int mode)
{
    int i, j;
    int first = 0x03, last = 0x77;
    int res;
    int slave_addr;
    char line[128];
    std::string text;

    snprintf(line, 128, "     0  1  2  3  4  5  6  7  8  9  a  b  c  d  e  f\r\n");
    text.append(line);

    for (i = 0; i < 128; i += 16)
    {
        snprintf(line, 128, "%02x: ", i);
        text.append(line);

        for (j = 0; j < 16; j++)
        {
            /* Skip unwanted addresses */
			if (i+j < first || i+j > last)
            {
                snprintf(line, 128, "   ");
                text.append(line);
				continue;
			}

            /* Set slave address */
            slave_addr = i + j;

            /* Probe this address */
            switch (mode)
            {
            case MODE_QUICK:
                res = bus->i2c_smbus_write_quick(slave_addr, I2C_SMBUS_WRITE);
                break;
            case MODE_READ:
                res = bus->i2c_smbus_read_byte(slave_addr);
                break;
            default:
                if ((i + j >= 0x30 && i + j <= 0x37)
                 || (i + j >= 0x50 && i + j <= 0x5F))
                    res = bus->i2c_smbus_read_byte(slave_addr);
                else
                    res = bus->i2c_smbus_write_quick(slave_addr, I2C_SMBUS_WRITE);
                break;
            }

            if (res < 0)
            {
                snprintf(line, 128, "-- ");
                text.append(line);
            }
            else
            {
                snprintf(line, 128, "%02x ", i + j);
                text.append(line);
            }