|
@@ -70,43 +70,6 @@ sensor_found:
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-int s5k83a_read_sensor(struct sd *sd, const u8 address,
|
|
|
- u8 *i2c_data, const u8 len)
|
|
|
-{
|
|
|
- int err, i;
|
|
|
-
|
|
|
- do {
|
|
|
- err = m5602_read_bridge(sd, M5602_XB_I2C_STATUS, i2c_data);
|
|
|
- } while ((*i2c_data & I2C_BUSY) && !err);
|
|
|
- if (err < 0)
|
|
|
- goto out;
|
|
|
-
|
|
|
- err = m5602_write_bridge(sd, M5602_XB_I2C_DEV_ADDR,
|
|
|
- sd->sensor->i2c_slave_id);
|
|
|
- if (err < 0)
|
|
|
- goto out;
|
|
|
-
|
|
|
- err = m5602_write_bridge(sd, M5602_XB_I2C_REG_ADDR, address);
|
|
|
- if (err < 0)
|
|
|
- goto out;
|
|
|
-
|
|
|
- err = m5602_write_bridge(sd, M5602_XB_I2C_CTRL, 0x18 + len);
|
|
|
-
|
|
|
- do {
|
|
|
- err = m5602_read_bridge(sd, M5602_XB_I2C_STATUS, i2c_data);
|
|
|
- } while ((*i2c_data & I2C_BUSY) && !err);
|
|
|
-
|
|
|
- for (i = 0; i < len && !len; i++) {
|
|
|
- err = m5602_read_bridge(sd, M5602_XB_I2C_DATA, &(i2c_data[i]));
|
|
|
-
|
|
|
- PDEBUG(D_CONF, "Reading sensor register "
|
|
|
- "0x%x containing 0x%x ", address, *i2c_data);
|
|
|
- }
|
|
|
-
|
|
|
-out:
|
|
|
- return err;
|
|
|
-}
|
|
|
-
|
|
|
int s5k83a_init(struct sd *sd)
|
|
|
{
|
|
|
int i, err = 0;
|