|
@@ -157,15 +157,10 @@ static u16 dib8000_i2c_read16(struct i2c_device *i2c, u16 reg)
|
|
|
return ret;
|
|
|
}
|
|
|
|
|
|
-static u16 dib8000_read_word(struct dib8000_state *state, u16 reg)
|
|
|
+static u16 __dib8000_read_word(struct dib8000_state *state, u16 reg)
|
|
|
{
|
|
|
u16 ret;
|
|
|
|
|
|
- if (mutex_lock_interruptible(&state->i2c_buffer_lock) < 0) {
|
|
|
- dprintk("could not acquire lock");
|
|
|
- return 0;
|
|
|
- }
|
|
|
-
|
|
|
state->i2c_write_buffer[0] = reg >> 8;
|
|
|
state->i2c_write_buffer[1] = reg & 0xff;
|
|
|
|
|
@@ -183,6 +178,21 @@ static u16 dib8000_read_word(struct dib8000_state *state, u16 reg)
|
|
|
dprintk("i2c read error on %d", reg);
|
|
|
|
|
|
ret = (state->i2c_read_buffer[0] << 8) | state->i2c_read_buffer[1];
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
+static u16 dib8000_read_word(struct dib8000_state *state, u16 reg)
|
|
|
+{
|
|
|
+ u16 ret;
|
|
|
+
|
|
|
+ if (mutex_lock_interruptible(&state->i2c_buffer_lock) < 0) {
|
|
|
+ dprintk("could not acquire lock");
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = __dib8000_read_word(state, reg);
|
|
|
+
|
|
|
mutex_unlock(&state->i2c_buffer_lock);
|
|
|
|
|
|
return ret;
|
|
@@ -192,8 +202,15 @@ static u32 dib8000_read32(struct dib8000_state *state, u16 reg)
|
|
|
{
|
|
|
u16 rw[2];
|
|
|
|
|
|
- rw[0] = dib8000_read_word(state, reg + 0);
|
|
|
- rw[1] = dib8000_read_word(state, reg + 1);
|
|
|
+ if (mutex_lock_interruptible(&state->i2c_buffer_lock) < 0) {
|
|
|
+ dprintk("could not acquire lock");
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ rw[0] = __dib8000_read_word(state, reg + 0);
|
|
|
+ rw[1] = __dib8000_read_word(state, reg + 1);
|
|
|
+
|
|
|
+ mutex_unlock(&state->i2c_buffer_lock);
|
|
|
|
|
|
return ((rw[0] << 16) | (rw[1]));
|
|
|
}
|