|
@@ -82,16 +82,6 @@ static const u8 TMP401_TEMP_MSB_WRITE[7][2] = {
|
|
|
{ 0, 0x11 }, /* offset */
|
|
|
};
|
|
|
|
|
|
-static const u8 TMP401_TEMP_LSB[7][2] = {
|
|
|
- { 0x15, 0x10 }, /* temp */
|
|
|
- { 0x17, 0x14 }, /* low limit */
|
|
|
- { 0x16, 0x13 }, /* high limit */
|
|
|
- { 0, 0 }, /* therm (crit) limit (unused) */
|
|
|
- { 0x31, 0x35 }, /* lowest */
|
|
|
- { 0x33, 0x37 }, /* highest */
|
|
|
- { 0, 0x12 }, /* offset */
|
|
|
-};
|
|
|
-
|
|
|
static const u8 TMP432_TEMP_MSB_READ[4][3] = {
|
|
|
{ 0x00, 0x01, 0x23 }, /* temp */
|
|
|
{ 0x06, 0x08, 0x16 }, /* low limit */
|
|
@@ -106,12 +96,6 @@ static const u8 TMP432_TEMP_MSB_WRITE[4][3] = {
|
|
|
{ 0x20, 0x19, 0x1A }, /* therm (crit) limit */
|
|
|
};
|
|
|
|
|
|
-static const u8 TMP432_TEMP_LSB[3][3] = {
|
|
|
- { 0x29, 0x10, 0x24 }, /* temp */
|
|
|
- { 0x3E, 0x14, 0x18 }, /* low limit */
|
|
|
- { 0x3D, 0x13, 0x17 }, /* high limit */
|
|
|
-};
|
|
|
-
|
|
|
/* [0] = fault, [1] = low, [2] = high, [3] = therm/crit */
|
|
|
static const u8 TMP432_STATUS_REG[] = {
|
|
|
0x1b, 0x36, 0x35, 0x37 };
|
|
@@ -213,25 +197,20 @@ static int tmp401_update_device_reg16(struct i2c_client *client,
|
|
|
for (i = 0; i < num_sensors; i++) { /* local / r1 / r2 */
|
|
|
for (j = 0; j < num_regs; j++) { /* temp / low / ... */
|
|
|
u8 regaddr;
|
|
|
- /*
|
|
|
- * High byte must be read first immediately followed
|
|
|
- * by the low byte
|
|
|
- */
|
|
|
+
|
|
|
regaddr = data->kind == tmp432 ?
|
|
|
TMP432_TEMP_MSB_READ[j][i] :
|
|
|
TMP401_TEMP_MSB_READ[j][i];
|
|
|
- val = i2c_smbus_read_byte_data(client, regaddr);
|
|
|
- if (val < 0)
|
|
|
- return val;
|
|
|
- data->temp[j][i] = val << 8;
|
|
|
- if (j == 3) /* crit is msb only */
|
|
|
- continue;
|
|
|
- regaddr = data->kind == tmp432 ? TMP432_TEMP_LSB[j][i]
|
|
|
- : TMP401_TEMP_LSB[j][i];
|
|
|
- val = i2c_smbus_read_byte_data(client, regaddr);
|
|
|
+ if (j == 3) { /* crit is msb only */
|
|
|
+ val = i2c_smbus_read_byte_data(client, regaddr);
|
|
|
+ } else {
|
|
|
+ val = i2c_smbus_read_word_swapped(client,
|
|
|
+ regaddr);
|
|
|
+ }
|
|
|
if (val < 0)
|
|
|
return val;
|
|
|
- data->temp[j][i] |= val;
|
|
|
+
|
|
|
+ data->temp[j][i] = j == 3 ? val << 8 : val;
|
|
|
}
|
|
|
}
|
|
|
return 0;
|
|
@@ -373,11 +352,11 @@ static ssize_t store_temp(struct device *dev, struct device_attribute *devattr,
|
|
|
|
|
|
regaddr = data->kind == tmp432 ? TMP432_TEMP_MSB_WRITE[nr][index]
|
|
|
: TMP401_TEMP_MSB_WRITE[nr][index];
|
|
|
- i2c_smbus_write_byte_data(client, regaddr, reg >> 8);
|
|
|
- if (nr != 3) {
|
|
|
- regaddr = data->kind == tmp432 ? TMP432_TEMP_LSB[nr][index]
|
|
|
- : TMP401_TEMP_LSB[nr][index];
|
|
|
- i2c_smbus_write_byte_data(client, regaddr, reg & 0xFF);
|
|
|
+ if (nr == 3) { /* crit is msb only */
|
|
|
+ i2c_smbus_write_byte_data(client, regaddr, reg >> 8);
|
|
|
+ } else {
|
|
|
+ /* Hardware expects big endian data --> use _swapped */
|
|
|
+ i2c_smbus_write_word_swapped(client, regaddr, reg);
|
|
|
}
|
|
|
data->temp[nr][index] = reg;
|
|
|
|