Commit de461a26 authored by Heiner Kallweit's avatar Heiner Kallweit Committed by Wolfram Sang

i2c: i801: Call i801_check_post() from i801_access()

Avoid code duplication by calling i801_check_post() from i801_access().
Signed-off-by: default avatarHeiner Kallweit <hkallweit1@gmail.com>
Reviewed-by: default avatarJean Delvare <jdelvare@suse.de>
Signed-off-by: default avatarWolfram Sang <wsa@kernel.org>
parent 1f760b87
...@@ -434,7 +434,7 @@ static int i801_wait_intr(struct i801_priv *priv) ...@@ -434,7 +434,7 @@ static int i801_wait_intr(struct i801_priv *priv)
busy = status & SMBHSTSTS_HOST_BUSY; busy = status & SMBHSTSTS_HOST_BUSY;
status &= STATUS_ERROR_FLAGS | SMBHSTSTS_INTR; status &= STATUS_ERROR_FLAGS | SMBHSTSTS_INTR;
if (!busy && status) if (!busy && status)
return status; return status & STATUS_ERROR_FLAGS;
} while (time_is_after_eq_jiffies(timeout)); } while (time_is_after_eq_jiffies(timeout));
return -ETIMEDOUT; return -ETIMEDOUT;
...@@ -458,7 +458,6 @@ static int i801_wait_byte_done(struct i801_priv *priv) ...@@ -458,7 +458,6 @@ static int i801_wait_byte_done(struct i801_priv *priv)
static int i801_transaction(struct i801_priv *priv, int xact) static int i801_transaction(struct i801_priv *priv, int xact)
{ {
int status;
unsigned long result; unsigned long result;
const struct i2c_adapter *adap = &priv->adapter; const struct i2c_adapter *adap = &priv->adapter;
...@@ -467,13 +466,12 @@ static int i801_transaction(struct i801_priv *priv, int xact) ...@@ -467,13 +466,12 @@ static int i801_transaction(struct i801_priv *priv, int xact)
outb_p(xact | SMBHSTCNT_INTREN | SMBHSTCNT_START, outb_p(xact | SMBHSTCNT_INTREN | SMBHSTCNT_START,
SMBHSTCNT(priv)); SMBHSTCNT(priv));
result = wait_for_completion_timeout(&priv->done, adap->timeout); result = wait_for_completion_timeout(&priv->done, adap->timeout);
return i801_check_post(priv, result ? priv->status : -ETIMEDOUT); return result ? priv->status : -ETIMEDOUT;
} }
outb_p(xact | SMBHSTCNT_START, SMBHSTCNT(priv)); outb_p(xact | SMBHSTCNT_START, SMBHSTCNT(priv));
status = i801_wait_intr(priv); return i801_wait_intr(priv);
return i801_check_post(priv, status);
} }
static int i801_block_transaction_by_block(struct i801_priv *priv, static int i801_block_transaction_by_block(struct i801_priv *priv,
...@@ -624,7 +622,7 @@ static irqreturn_t i801_isr(int irq, void *dev_id) ...@@ -624,7 +622,7 @@ static irqreturn_t i801_isr(int irq, void *dev_id)
status &= STATUS_ERROR_FLAGS | SMBHSTSTS_INTR; status &= STATUS_ERROR_FLAGS | SMBHSTSTS_INTR;
if (status) { if (status) {
priv->status = status; priv->status = status & STATUS_ERROR_FLAGS;
complete(&priv->done); complete(&priv->done);
} }
...@@ -674,7 +672,7 @@ static int i801_block_transaction_byte_by_byte(struct i801_priv *priv, ...@@ -674,7 +672,7 @@ static int i801_block_transaction_byte_by_byte(struct i801_priv *priv,
reinit_completion(&priv->done); reinit_completion(&priv->done);
outb_p(priv->cmd | SMBHSTCNT_START, SMBHSTCNT(priv)); outb_p(priv->cmd | SMBHSTCNT_START, SMBHSTCNT(priv));
result = wait_for_completion_timeout(&priv->done, adap->timeout); result = wait_for_completion_timeout(&priv->done, adap->timeout);
return i801_check_post(priv, result ? priv->status : -ETIMEDOUT); return result ? priv->status : -ETIMEDOUT;
} }
for (i = 1; i <= len; i++) { for (i = 1; i <= len; i++) {
...@@ -688,7 +686,7 @@ static int i801_block_transaction_byte_by_byte(struct i801_priv *priv, ...@@ -688,7 +686,7 @@ static int i801_block_transaction_byte_by_byte(struct i801_priv *priv,
status = i801_wait_byte_done(priv); status = i801_wait_byte_done(priv);
if (status) if (status)
goto exit; return status;
if (i == 1 && read_write == I2C_SMBUS_READ if (i == 1 && read_write == I2C_SMBUS_READ
&& command != I2C_SMBUS_I2C_BLOCK_DATA) { && command != I2C_SMBUS_I2C_BLOCK_DATA) {
...@@ -718,9 +716,7 @@ static int i801_block_transaction_byte_by_byte(struct i801_priv *priv, ...@@ -718,9 +716,7 @@ static int i801_block_transaction_byte_by_byte(struct i801_priv *priv,
outb_p(SMBHSTSTS_BYTE_DONE, SMBHSTSTS(priv)); outb_p(SMBHSTSTS_BYTE_DONE, SMBHSTSTS(priv));
} }
status = i801_wait_intr(priv); return i801_wait_intr(priv);
exit:
return i801_check_post(priv, status);
} }
static void i801_set_hstadd(struct i801_priv *priv, u8 addr, char read_write) static void i801_set_hstadd(struct i801_priv *priv, u8 addr, char read_write)
...@@ -904,6 +900,8 @@ static s32 i801_access(struct i2c_adapter *adap, u16 addr, ...@@ -904,6 +900,8 @@ static s32 i801_access(struct i2c_adapter *adap, u16 addr,
else else
ret = i801_simple_transaction(priv, data, addr, command, read_write, size); ret = i801_simple_transaction(priv, data, addr, command, read_write, size);
ret = i801_check_post(priv, ret);
/* Some BIOSes don't like it when PEC is enabled at reboot or resume /* Some BIOSes don't like it when PEC is enabled at reboot or resume
* time, so we forcibly disable it after every transaction. * time, so we forcibly disable it after every transaction.
*/ */
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment