i2c: mvtwsi: Factor out adap parameter
authormario.six@gdsys.cc <mario.six@gdsys.cc>
Thu, 21 Jul 2016 09:57:08 +0000 (11:57 +0200)
committerHeiko Schocher <hs@denx.de>
Tue, 26 Jul 2016 08:19:56 +0000 (10:19 +0200)
To be able to use the compatibility layer from the DM functions, we
factor the adap parameter out of all functions, and pass the actual
register base instead.

Signed-off-by: Mario Six <mario.six@gdsys.cc>
Reviewed-by: Stefan Roese <sr@denx.de>
drivers/i2c/mvtwsi.c

index f1bfd5d02cf745b4aece4ceee07a9c6febd01e32..688efc2a2391ea5f56618b9b4084c7cdc2ea3eb6 100644 (file)
@@ -208,9 +208,8 @@ inline uint mvtwsi_error(uint ec, uint lc, uint ls, uint es)
  * Wait for IFLG to raise, or return 'timeout.' Then, if the status is as
  * expected, return 0 (ok) or 'wrong status' otherwise.
  */
-static int twsi_wait(struct i2c_adapter *adap, int expected_status)
+static int twsi_wait(struct mvtwsi_registers *twsi, int expected_status)
 {
-       struct mvtwsi_registers *twsi = twsi_get_base(adap);
        int control, status;
        int timeout = 1000;
 
@@ -236,39 +235,35 @@ static int twsi_wait(struct i2c_adapter *adap, int expected_status)
  * Assert the START condition, either in a single I2C transaction
  * or inside back-to-back ones (repeated starts).
  */
-static int twsi_start(struct i2c_adapter *adap, int expected_status)
+static int twsi_start(struct mvtwsi_registers *twsi, int expected_status)
 {
-       struct mvtwsi_registers *twsi = twsi_get_base(adap);
-
        /* Assert START */
        writel(MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_START |
               MVTWSI_CONTROL_CLEAR_IFLG, &twsi->control);
        /* Wait for controller to process START */
-       return twsi_wait(adap, expected_status);
+       return twsi_wait(twsi, expected_status);
 }
 
 /*
  * Send a byte (i2c address or data).
  */
-static int twsi_send(struct i2c_adapter *adap, u8 byte, int expected_status)
+static int twsi_send(struct mvtwsi_registers *twsi, u8 byte,
+                    int expected_status)
 {
-       struct mvtwsi_registers *twsi = twsi_get_base(adap);
-
        /* Write byte to data register for sending */
        writel(byte, &twsi->data);
        /* Clear any pending interrupt -- that will cause sending */
        writel(MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_CLEAR_IFLG,
               &twsi->control);
        /* Wait for controller to receive byte, and check ACK */
-       return twsi_wait(adap, expected_status);
+       return twsi_wait(twsi, expected_status);
 }
 
 /*
  * Receive a byte.
  */
-static int twsi_recv(struct i2c_adapter *adap, u8 *byte, int ack_flag)
+static int twsi_recv(struct mvtwsi_registers *twsi, u8 *byte, int ack_flag)
 {
-       struct mvtwsi_registers *twsi = twsi_get_base(adap);
        int expected_status, status, control;
 
        /* Compute expected status based on passed ACK flag */
@@ -279,7 +274,7 @@ static int twsi_recv(struct i2c_adapter *adap, u8 *byte, int ack_flag)
        control |= ack_flag == MVTWSI_READ_ACK ? MVTWSI_CONTROL_ACK : 0;
        writel(control | MVTWSI_CONTROL_CLEAR_IFLG, &twsi->control);
        /* Wait for controller to receive byte, and assert ACK or NAK */
-       status = twsi_wait(adap, expected_status);
+       status = twsi_wait(twsi, expected_status);
        /* If we did receive the expected byte, store it */
        if (status == 0)
                *byte = readl(&twsi->data);
@@ -290,9 +285,8 @@ static int twsi_recv(struct i2c_adapter *adap, u8 *byte, int ack_flag)
  * Assert the STOP condition.
  * This is also used to force the bus back to idle (SDA = SCL = 1).
  */
-static int twsi_stop(struct i2c_adapter *adap)
+static int twsi_stop(struct mvtwsi_registers *twsi)
 {
-       struct mvtwsi_registers *twsi = twsi_get_base(adap);
        int control, stop_status;
        int status = 0;
        int timeout = 1000;
@@ -328,10 +322,8 @@ static uint twsi_calc_freq(const int n, const int m)
  * Controller reset also resets the baud rate and slave address, so
  * they must be re-established afterwards.
  */
-static void twsi_reset(struct i2c_adapter *adap)
+static void twsi_reset(struct mvtwsi_registers *twsi)
 {
-       struct mvtwsi_registers *twsi = twsi_get_base(adap);
-
        /* Reset controller */
        writel(0, &twsi->soft_reset);
        /* Wait 2 ms -- this is what the Marvell LSP does */
@@ -341,10 +333,9 @@ static void twsi_reset(struct i2c_adapter *adap)
 /*
  * Sets baud to the highest possible value not exceeding the requested one.
  */
-static uint __twsi_i2c_set_bus_speed(struct i2c_adapter *adap,
+static uint __twsi_i2c_set_bus_speed(struct mvtwsi_registers *twsi,
                                     uint requested_speed)
 {
-       struct mvtwsi_registers *twsi = twsi_get_base(adap);
        uint tmp_speed, highest_speed, n, m;
        uint baud = 0x44; /* Baud rate after controller reset */
 
@@ -366,26 +357,25 @@ static uint __twsi_i2c_set_bus_speed(struct i2c_adapter *adap,
        return 0;
 }
 
-static void __twsi_i2c_init(struct i2c_adapter *adap, int speed, int slaveadd)
+static void __twsi_i2c_init(struct mvtwsi_registers *twsi, int speed,
+                         int slaveadd)
 {
-       struct mvtwsi_registers *twsi = twsi_get_base(adap);
-
        /* Reset controller */
-       twsi_reset(adap);
+       twsi_reset(twsi);
        /* Set speed */
-       __twsi_i2c_set_bus_speed(adap, speed);
+       __twsi_i2c_set_bus_speed(twsi, speed);
        /* Set slave address; even though we don't use it */
        writel(slaveadd, &twsi->slave_address);
        writel(0, &twsi->xtnd_slave_addr);
        /* Assert STOP, but don't care for the result */
-       (void) twsi_stop(adap);
+       (void) twsi_stop(twsi);
 }
 
 /*
  * Begin I2C transaction with expected start status, at given address.
  * Expected address status will derive from direction bit (bit 0) in addr.
  */
-static int i2c_begin(struct i2c_adapter *adap, int expected_start_status,
+static int i2c_begin(struct mvtwsi_registers *twsi, int expected_start_status,
                     u8 addr)
 {
        int status, expected_addr_status;
@@ -397,10 +387,10 @@ static int i2c_begin(struct i2c_adapter *adap, int expected_start_status,
        else /* Writing */
                expected_addr_status = MVTWSI_STATUS_ADDR_W_ACK;
        /* Assert START */
-       status = twsi_start(adap, expected_start_status);
+       status = twsi_start(twsi, expected_start_status);
        /* Send out the address if the start went well */
        if (status == 0)
-               status = twsi_send(adap, addr, expected_addr_status);
+               status = twsi_send(twsi, addr, expected_addr_status);
        /* Return 0, or the status of the first failure */
        return status;
 }
@@ -408,18 +398,18 @@ static int i2c_begin(struct i2c_adapter *adap, int expected_start_status,
 /*
  * Begin read, nak data byte, end.
  */
-static int __twsi_i2c_probe_chip(struct i2c_adapter *adap, uchar chip)
+static int __twsi_i2c_probe_chip(struct mvtwsi_registers *twsi, uchar chip)
 {
        u8 dummy_byte;
        int status;
 
        /* Begin i2c read */
-       status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1) | 1);
+       status = i2c_begin(twsi, MVTWSI_STATUS_START, (chip << 1) | 1);
        /* Dummy read was accepted: receive byte, but NAK it. */
        if (status == 0)
-               status = twsi_recv(adap, &dummy_byte, MVTWSI_READ_NAK);
+               status = twsi_recv(twsi, &dummy_byte, MVTWSI_READ_NAK);
        /* Stop transaction */
-       twsi_stop(adap);
+       twsi_stop(twsi);
        /* Return 0, or the status of the first failure */
        return status;
 }
@@ -432,30 +422,30 @@ static int __twsi_i2c_probe_chip(struct i2c_adapter *adap, uchar chip)
  * higher level APIs, we need to make a decision here, and for the moment that
  * will be a repeated start without a preceding stop.
  */
-static int __twsi_i2c_read(struct i2c_adapter *adap, uchar chip, uint addr,
-                          int alen, uchar *data, int length)
+static int __twsi_i2c_read(struct mvtwsi_registers *twsi, uchar chip,
+                          uint addr, int alen, uchar *data, int length)
 {
        int status = 0;
        int stop_status;
 
        /* Begin i2c write to send the address bytes */
-       status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1));
+       status = i2c_begin(twsi, MVTWSI_STATUS_START, (chip << 1));
        /* Send address bytes */
        while ((status == 0) && alen--)
-               status = twsi_send(adap, addr >> (8*alen),
+               status = twsi_send(twsi, addr >> (8*alen),
                        MVTWSI_STATUS_DATA_W_ACK);
        /* Begin i2c read to receive data bytes */
        if (status == 0)
-               status = i2c_begin(adap, MVTWSI_STATUS_REPEATED_START,
+               status = i2c_begin(twsi, MVTWSI_STATUS_REPEATED_START,
                                   (chip << 1) | 1);
        /* Receive actual data bytes; set NAK if we if we have nothing more to
         * read */
        while ((status == 0) && length--)
-               status = twsi_recv(adap, data++,
+               status = twsi_recv(twsi, data++,
                                   length > 0 ?
                                   MVTWSI_READ_ACK : MVTWSI_READ_NAK);
        /* Stop transaction */
-       stop_status = twsi_stop(adap);
+       stop_status = twsi_stop(twsi);
        /* Return 0, or the status of the first failure */
        return status != 0 ? status : stop_status;
 }
@@ -463,23 +453,23 @@ static int __twsi_i2c_read(struct i2c_adapter *adap, uchar chip, uint addr,
 /*
  * Begin write, send address byte(s), send data bytes, end.
  */
-static int __twsi_i2c_write(struct i2c_adapter *adap, uchar chip, uint addr,
-                           int alen, uchar *data, int length)
+static int __twsi_i2c_write(struct mvtwsi_registers *twsi, uchar chip,
+                           uint addr, int alen, uchar *data, int length)
 {
        int status, stop_status;
 
        /* Begin i2c write to send first the address bytes, then the
         * data bytes */
-       status = i2c_begin(adap, MVTWSI_STATUS_START, (chip << 1));
+       status = i2c_begin(twsi, MVTWSI_STATUS_START, (chip << 1));
        /* Send address bytes */
        while ((status == 0) && alen--)
-               status = twsi_send(adap, addr >> (8*alen),
+               status = twsi_send(twsi, addr >> (8*alen),
                        MVTWSI_STATUS_DATA_W_ACK);
        /* Send data bytes */
        while ((status == 0) && (length-- > 0))
-               status = twsi_send(adap, *(data++), MVTWSI_STATUS_DATA_W_ACK);
+               status = twsi_send(twsi, *(data++), MVTWSI_STATUS_DATA_W_ACK);
        /* Stop transaction */
-       stop_status = twsi_stop(adap);
+       stop_status = twsi_stop(twsi);
        /* Return 0, or the status of the first failure */
        return status != 0 ? status : stop_status;
 }
@@ -487,30 +477,35 @@ static int __twsi_i2c_write(struct i2c_adapter *adap, uchar chip, uint addr,
 static void twsi_i2c_init(struct i2c_adapter *adap, int speed,
                          int slaveadd)
 {
-       __twsi_i2c_init(adap, speed, slaveadd);
+       struct mvtwsi_registers *twsi = twsi_get_base(adap);
+       __twsi_i2c_init(twsi, speed, slaveadd);
 }
 
 static uint twsi_i2c_set_bus_speed(struct i2c_adapter *adap,
                                   uint requested_speed)
 {
-       return __twsi_i2c_set_bus_speed(adap, requested_speed);
+       struct mvtwsi_registers *twsi = twsi_get_base(adap);
+       return __twsi_i2c_set_bus_speed(twsi, requested_speed);
 }
 
 static int twsi_i2c_probe(struct i2c_adapter *adap, uchar chip)
 {
-       return __twsi_i2c_probe_chip(adap, chip);
+       struct mvtwsi_registers *twsi = twsi_get_base(adap);
+       return __twsi_i2c_probe_chip(twsi, chip);
 }
 
 static int twsi_i2c_read(struct i2c_adapter *adap, uchar chip, uint addr,
                         int alen, uchar *data, int length)
 {
-       return __twsi_i2c_read(adap, chip, addr, alen, data, length);
+       struct mvtwsi_registers *twsi = twsi_get_base(adap);
+       return __twsi_i2c_read(twsi, chip, addr, alen, data, length);
 }
 
 static int twsi_i2c_write(struct i2c_adapter *adap, uchar chip, uint addr,
                          int alen, uchar *data, int length)
 {
-       return __twsi_i2c_write(adap, chip, addr, alen, data, length);
+       struct mvtwsi_registers *twsi = twsi_get_base(adap);
+       return __twsi_i2c_write(twsi, chip, addr, alen, data, length);
 }
 
 #ifdef CONFIG_I2C_MVTWSI_BASE0