static int w83l785ts_detect(struct i2c_client *new_client, int kind, struct i2c_board_info *info) { struct i2c_adapter *adapter = new_client->adapter; if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) return -ENODEV; if (kind < 0) { if (((w83l785ts_read_value(new_client, W83L785TS_REG_CONFIG, 0) & 0x80) != 0x00) || ((w83l785ts_read_value(new_client, W83L785TS_REG_TYPE, 0) & 0xFC) != 0x00)) { dev_dbg(&adapter->dev, "W83L785TS-S detection failed at 0x%02x.\n", new_client->addr); return -ENODEV; } } if (kind <= 0) { u16 man_id; u8 chip_id; man_id = (w83l785ts_read_value(new_client, W83L785TS_REG_MAN_ID1, 0) << 8) + w83l785ts_read_value(new_client, W83L785TS_REG_MAN_ID2, 0); chip_id = w83l785ts_read_value(new_client, W83L785TS_REG_CHIP_ID, 0); if (man_id == 0x5CA3) { if (chip_id == 0x70) { kind = w83l785ts; } } if (kind <= 0) { dev_info(&adapter->dev, "Unsupported chip (man_id=0x%04X, " "chip_id=0x%02X).\n", man_id, chip_id); return -ENODEV; } } strlcpy(info->type, "w83l785ts", I2C_NAME_SIZE); return 0; }
static struct w83l785ts_data *w83l785ts_update_device(struct device *dev) { struct i2c_client *client = to_i2c_client(dev); struct w83l785ts_data *data = i2c_get_clientdata(client); mutex_lock(&data->update_lock); if (!data->valid || time_after(jiffies, data->last_updated + HZ * 2)) { dev_dbg(&client->dev, "Updating w83l785ts data.\n"); data->temp[0] = w83l785ts_read_value(client, W83L785TS_REG_TEMP, data->temp[0]); data->temp[1] = w83l785ts_read_value(client, W83L785TS_REG_TEMP_OVER, data->temp[1]); data->last_updated = jiffies; data->valid = 1; } mutex_unlock(&data->update_lock); return data; }
/* Return 0 if detection is successful, -ENODEV otherwise */ static int w83l785ts_detect(struct i2c_client *client, struct i2c_board_info *info) { struct i2c_adapter *adapter = client->adapter; u16 man_id; u8 chip_id; if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) return -ENODEV; /* detection */ if ((w83l785ts_read_value(client, W83L785TS_REG_CONFIG, 0) & 0x80) || (w83l785ts_read_value(client, W83L785TS_REG_TYPE, 0) & 0xFC)) { dev_dbg(&adapter->dev, "W83L785TS-S detection failed at 0x%02x\n", client->addr); return -ENODEV; } /* Identification */ man_id = (w83l785ts_read_value(client, W83L785TS_REG_MAN_ID1, 0) << 8) + w83l785ts_read_value(client, W83L785TS_REG_MAN_ID2, 0); chip_id = w83l785ts_read_value(client, W83L785TS_REG_CHIP_ID, 0); if (man_id != 0x5CA3 /* Winbond */ || chip_id != 0x70) { /* W83L785TS-S */ dev_dbg(&adapter->dev, "Unsupported chip (man_id=0x%04X, chip_id=0x%02X)\n", man_id, chip_id); return -ENODEV; } strlcpy(info->type, "w83l785ts", I2C_NAME_SIZE); return 0; }