1 files changed, 29 insertions, 17 deletions

diff --git a/drivers/i2c/busses/i2c-nomadik.c b/drivers/i2c/busses/i2c-nomadik.c
index 6db453fe68e..e6b93f3ca86 100644
--- a/drivers/i2c/busses/i2c-nomadik.c
+++ b/drivers/i2c/busses/i2c-nomadik.c
@@ -276,15 +276,32 @@ exit:
 /**
  * load_i2c_mcr_reg() - load the MCR register
  * @dev: private data of controller
+ * @flags: message flags
  */
-static u32 load_i2c_mcr_reg(struct nmk_i2c_dev *dev)
+static u32 load_i2c_mcr_reg(struct nmk_i2c_dev *dev, u16 flags)
 {
         u32 mcr = 0;
+        unsigned short slave_adr_3msb_bits;
 
-        /* 7-bit address transaction */
-        mcr |= GEN_MASK(1, I2C_MCR_AM, 12);
         mcr |= GEN_MASK(dev->cli.slave_adr, I2C_MCR_A7, 1);
 
+        if (unlikely(flags & I2C_M_TEN)) {
+                /* 10-bit address transaction */
+                mcr |= GEN_MASK(2, I2C_MCR_AM, 12);
+                /*
+                 * Get the top 3 bits.
+                 * EA10 represents extended address in MCR. This includes
+                 * the extension (MSB bits) of the 7 bit address loaded
+                 * in A7
+                 */
+                slave_adr_3msb_bits = (dev->cli.slave_adr >> 7) & 0x7;
+
+                mcr |= GEN_MASK(slave_adr_3msb_bits, I2C_MCR_EA10, 8);
+        } else {
+                /* 7-bit address transaction */
+                mcr |= GEN_MASK(1, I2C_MCR_AM, 12);
+        }
+
         /* start byte procedure not applied */
         mcr |= GEN_MASK(0, I2C_MCR_SB, 11);
 
@@ -381,19 +398,20 @@ static void setup_i2c_controller(struct nmk_i2c_dev *dev)
 /**
  * read_i2c() - Read from I2C client device
  * @dev: private data of I2C Driver
+ * @flags: message flags
  *
  * This function reads from i2c client device when controller is in
  * master mode. There is a completion timeout. If there is no transfer
  * before timeout error is returned.
  */
-static int read_i2c(struct nmk_i2c_dev *dev)
+static int read_i2c(struct nmk_i2c_dev *dev, u16 flags)
 {
         u32 status = 0;
         u32 mcr;
         u32 irq_mask = 0;
         int timeout;
 
-        mcr = load_i2c_mcr_reg(dev);
+        mcr = load_i2c_mcr_reg(dev, flags);
         writel(mcr, dev->virtbase + I2C_MCR);
 
         /* load the current CR value */
@@ -459,17 +477,18 @@ static void fill_tx_fifo(struct nmk_i2c_dev *dev, int no_bytes)
 /**
  * write_i2c() - Write data to I2C client.
  * @dev: private data of I2C Driver
+ * @flags: message flags
  *
  * This function writes data to I2C client
  */
-static int write_i2c(struct nmk_i2c_dev *dev)
+static int write_i2c(struct nmk_i2c_dev *dev, u16 flags)
 {
         u32 status = 0;
         u32 mcr;
         u32 irq_mask = 0;
         int timeout;
 
-        mcr = load_i2c_mcr_reg(dev);
+        mcr = load_i2c_mcr_reg(dev, flags);
 
         writel(mcr, dev->virtbase + I2C_MCR);
 
@@ -538,11 +557,11 @@ static int nmk_i2c_xfer_one(struct nmk_i2c_dev *dev, u16 flags)
         if (flags & I2C_M_RD) {
                 /* read operation */
                 dev->cli.operation = I2C_READ;
-                status = read_i2c(dev);
+                status = read_i2c(dev, flags);
         } else {
                 /* write operation */
                 dev->cli.operation = I2C_WRITE;
-                status = write_i2c(dev);
+                status = write_i2c(dev, flags);
         }
 
         if (status || (dev->result)) {
@@ -644,13 +663,6 @@ static int nmk_i2c_xfer(struct i2c_adapter *i2c_adap,
                 setup_i2c_controller(dev);
 
                 for (i = 0; i < num_msgs; i++) {
-                        if (unlikely(msgs[i].flags & I2C_M_TEN)) {
-                                dev_err(&dev->adev->dev,
-                                        "10 bit addressing not supported\n");
-
-                                status = -EINVAL;
-                                goto out;
-                        }
                         dev->cli.slave_adr      = msgs[i].addr;
                         dev->cli.buffer         = msgs[i].buf;
                         dev->cli.count          = msgs[i].len;
@@ -891,7 +903,7 @@ static const struct dev_pm_ops nmk_i2c_pm = {
 
 static unsigned int nmk_i2c_functionality(struct i2c_adapter *adap)
 {
-        return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
+        return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL | I2C_FUNC_10BIT_ADDR;
 }
 
 static const struct i2c_algorithm nmk_i2c_algo = {