Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 1 | /* |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 2 | * Driver for the TWSI (i2c) controller found on the Marvell |
| 3 | * orion5x and kirkwood SoC families. |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 4 | * |
Albert ARIBAUD | 340983d | 2011-04-22 19:41:02 +0200 | [diff] [blame] | 5 | * Author: Albert Aribaud <albert.u.boot@aribaud.net> |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 6 | * Copyright (c) 2010 Albert Aribaud. |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 7 | * |
Wolfgang Denk | d79de1d | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 8 | * SPDX-License-Identifier: GPL-2.0+ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 9 | */ |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 10 | |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 11 | #include <common.h> |
| 12 | #include <i2c.h> |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 13 | #include <asm/errno.h> |
| 14 | #include <asm/io.h> |
| 15 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 16 | /* |
| 17 | * include a file that will provide CONFIG_I2C_MVTWSI_BASE |
| 18 | * and possibly other settings |
| 19 | */ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 20 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 21 | #if defined(CONFIG_ORION5X) |
| 22 | #include <asm/arch/orion5x.h> |
| 23 | #elif defined(CONFIG_KIRKWOOD) |
| 24 | #include <asm/arch/kirkwood.h> |
| 25 | #else |
| 26 | #error Driver mvtwsi not supported by SoC or board |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 27 | #endif |
| 28 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 29 | /* |
| 30 | * TWSI register structure |
| 31 | */ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 32 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 33 | struct mvtwsi_registers { |
| 34 | u32 slave_address; |
| 35 | u32 data; |
| 36 | u32 control; |
| 37 | union { |
| 38 | u32 status; /* when reading */ |
| 39 | u32 baudrate; /* when writing */ |
| 40 | }; |
| 41 | u32 xtnd_slave_addr; |
| 42 | u32 reserved[2]; |
| 43 | u32 soft_reset; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 44 | }; |
| 45 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 46 | /* |
| 47 | * Control register fields |
| 48 | */ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 49 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 50 | #define MVTWSI_CONTROL_ACK 0x00000004 |
| 51 | #define MVTWSI_CONTROL_IFLG 0x00000008 |
| 52 | #define MVTWSI_CONTROL_STOP 0x00000010 |
| 53 | #define MVTWSI_CONTROL_START 0x00000020 |
| 54 | #define MVTWSI_CONTROL_TWSIEN 0x00000040 |
| 55 | #define MVTWSI_CONTROL_INTEN 0x00000080 |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 56 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 57 | /* |
| 58 | * Status register values -- only those expected in normal master |
| 59 | * operation on non-10-bit-address devices; whatever status we don't |
| 60 | * expect in nominal conditions (bus errors, arbitration losses, |
| 61 | * missing ACKs...) we just pass back to the caller as an error |
| 62 | * code. |
| 63 | */ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 64 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 65 | #define MVTWSI_STATUS_START 0x08 |
| 66 | #define MVTWSI_STATUS_REPEATED_START 0x10 |
| 67 | #define MVTWSI_STATUS_ADDR_W_ACK 0x18 |
| 68 | #define MVTWSI_STATUS_DATA_W_ACK 0x28 |
| 69 | #define MVTWSI_STATUS_ADDR_R_ACK 0x40 |
| 70 | #define MVTWSI_STATUS_ADDR_R_NAK 0x48 |
| 71 | #define MVTWSI_STATUS_DATA_R_ACK 0x50 |
| 72 | #define MVTWSI_STATUS_DATA_R_NAK 0x58 |
| 73 | #define MVTWSI_STATUS_IDLE 0xF8 |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 74 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 75 | /* |
| 76 | * The single instance of the controller we'll be dealing with |
| 77 | */ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 78 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 79 | static struct mvtwsi_registers *twsi = |
| 80 | (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 81 | |
| 82 | /* |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 83 | * Returned statuses are 0 for success and nonzero otherwise. |
| 84 | * Currently, cmd_i2c and cmd_eeprom do not interpret an error status. |
| 85 | * Thus to ease debugging, the return status contains some debug info: |
| 86 | * - bits 31..24 are error class: 1 is timeout, 2 is 'status mismatch'. |
| 87 | * - bits 23..16 are the last value of the control register. |
| 88 | * - bits 15..8 are the last value of the status register. |
| 89 | * - bits 7..0 are the expected value of the status register. |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 90 | */ |
| 91 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 92 | #define MVTWSI_ERROR_WRONG_STATUS 0x01 |
| 93 | #define MVTWSI_ERROR_TIMEOUT 0x02 |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 94 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 95 | #define MVTWSI_ERROR(ec, lc, ls, es) (((ec << 24) & 0xFF000000) | \ |
| 96 | ((lc << 16) & 0x00FF0000) | ((ls<<8) & 0x0000FF00) | (es & 0xFF)) |
| 97 | |
| 98 | /* |
| 99 | * Wait for IFLG to raise, or return 'timeout'; then if status is as expected, |
| 100 | * return 0 (ok) or return 'wrong status'. |
| 101 | */ |
| 102 | static int twsi_wait(int expected_status) |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 103 | { |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 104 | int control, status; |
| 105 | int timeout = 1000; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 106 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 107 | do { |
| 108 | control = readl(&twsi->control); |
| 109 | if (control & MVTWSI_CONTROL_IFLG) { |
| 110 | status = readl(&twsi->status); |
| 111 | if (status == expected_status) |
| 112 | return 0; |
| 113 | else |
| 114 | return MVTWSI_ERROR( |
| 115 | MVTWSI_ERROR_WRONG_STATUS, |
| 116 | control, status, expected_status); |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 117 | } |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 118 | udelay(10); /* one clock cycle at 100 kHz */ |
| 119 | } while (timeout--); |
| 120 | status = readl(&twsi->status); |
| 121 | return MVTWSI_ERROR( |
| 122 | MVTWSI_ERROR_TIMEOUT, control, status, expected_status); |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 123 | } |
| 124 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 125 | /* |
| 126 | * These flags are ORed to any write to the control register |
| 127 | * They allow global setting of TWSIEN and ACK. |
| 128 | * By default none are set. |
| 129 | * twsi_start() sets TWSIEN (in case the controller was disabled) |
| 130 | * twsi_recv() sets ACK or resets it depending on expected status. |
| 131 | */ |
| 132 | static u8 twsi_control_flags = MVTWSI_CONTROL_TWSIEN; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 133 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 134 | /* |
| 135 | * Assert the START condition, either in a single I2C transaction |
| 136 | * or inside back-to-back ones (repeated starts). |
| 137 | */ |
| 138 | static int twsi_start(int expected_status) |
| 139 | { |
| 140 | /* globally set TWSIEN in case it was not */ |
| 141 | twsi_control_flags |= MVTWSI_CONTROL_TWSIEN; |
| 142 | /* assert START */ |
| 143 | writel(twsi_control_flags | MVTWSI_CONTROL_START, &twsi->control); |
| 144 | /* wait for controller to process START */ |
| 145 | return twsi_wait(expected_status); |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 146 | } |
| 147 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 148 | /* |
| 149 | * Send a byte (i2c address or data). |
| 150 | */ |
| 151 | static int twsi_send(u8 byte, int expected_status) |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 152 | { |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 153 | /* put byte in data register for sending */ |
| 154 | writel(byte, &twsi->data); |
| 155 | /* clear any pending interrupt -- that'll cause sending */ |
| 156 | writel(twsi_control_flags, &twsi->control); |
| 157 | /* wait for controller to receive byte and check ACK */ |
| 158 | return twsi_wait(expected_status); |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 159 | } |
| 160 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 161 | /* |
| 162 | * Receive a byte. |
| 163 | * Global mvtwsi_control_flags variable says if we should ack or nak. |
| 164 | */ |
| 165 | static int twsi_recv(u8 *byte) |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 166 | { |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 167 | int expected_status, status; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 168 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 169 | /* compute expected status based on ACK bit in global control flags */ |
| 170 | if (twsi_control_flags & MVTWSI_CONTROL_ACK) |
| 171 | expected_status = MVTWSI_STATUS_DATA_R_ACK; |
| 172 | else |
| 173 | expected_status = MVTWSI_STATUS_DATA_R_NAK; |
| 174 | /* acknowledge *previous state* and launch receive */ |
| 175 | writel(twsi_control_flags, &twsi->control); |
| 176 | /* wait for controller to receive byte and assert ACK or NAK */ |
| 177 | status = twsi_wait(expected_status); |
| 178 | /* if we did receive expected byte then store it */ |
| 179 | if (status == 0) |
| 180 | *byte = readl(&twsi->data); |
| 181 | /* return status */ |
| 182 | return status; |
| 183 | } |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 184 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 185 | /* |
| 186 | * Assert the STOP condition. |
| 187 | * This is also used to force the bus back in idle (SDA=SCL=1). |
| 188 | */ |
| 189 | static int twsi_stop(int status) |
| 190 | { |
| 191 | int control, stop_status; |
| 192 | int timeout = 1000; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 193 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 194 | /* assert STOP */ |
| 195 | control = MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_STOP; |
| 196 | writel(control, &twsi->control); |
| 197 | /* wait for IDLE; IFLG won't rise so twsi_wait() is no use. */ |
| 198 | do { |
| 199 | stop_status = readl(&twsi->status); |
| 200 | if (stop_status == MVTWSI_STATUS_IDLE) |
| 201 | break; |
| 202 | udelay(10); /* one clock cycle at 100 kHz */ |
| 203 | } while (timeout--); |
| 204 | control = readl(&twsi->control); |
| 205 | if (stop_status != MVTWSI_STATUS_IDLE) |
| 206 | if (status == 0) |
| 207 | status = MVTWSI_ERROR( |
| 208 | MVTWSI_ERROR_TIMEOUT, |
| 209 | control, status, MVTWSI_STATUS_IDLE); |
| 210 | return status; |
| 211 | } |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 212 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 213 | /* |
| 214 | * Ugly formula to convert m and n values to a frequency comes from |
| 215 | * TWSI specifications |
| 216 | */ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 217 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 218 | #define TWSI_FREQUENCY(m, n) \ |
| 219 | ((u8) (CONFIG_SYS_TCLK / (10 * (m + 1) * 2 * (1 << n)))) |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 220 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 221 | /* |
| 222 | * These are required to be reprogrammed before enabling the controller |
| 223 | * because a reset loses them. |
| 224 | * Default values come from the spec, but a twsi_reset will change them. |
| 225 | * twsi_slave_address left uninitialized lest checkpatch.pl complains. |
| 226 | */ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 227 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 228 | /* Baudrate generator: m (bits 7..4) =4, n (bits 3..0) =4 */ |
| 229 | static u8 twsi_baud_rate = 0x44; /* baudrate at controller reset */ |
| 230 | /* Default frequency corresponding to default m=4, n=4 */ |
| 231 | static u8 twsi_actual_speed = TWSI_FREQUENCY(4, 4); |
| 232 | /* Default slave address is 0 (so is an uninitialized static) */ |
| 233 | static u8 twsi_slave_address; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 234 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 235 | /* |
| 236 | * Reset controller. |
| 237 | * Called at end of i2c_init unsuccessful i2c transactions. |
| 238 | * Controller reset also resets the baud rate and slave address, so |
| 239 | * re-establish them. |
| 240 | */ |
| 241 | static void twsi_reset(void) |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 242 | { |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 243 | /* ensure controller will be enabled by any twsi*() function */ |
| 244 | twsi_control_flags = MVTWSI_CONTROL_TWSIEN; |
| 245 | /* reset controller */ |
| 246 | writel(0, &twsi->soft_reset); |
| 247 | /* wait 2 ms -- this is what the Marvell LSP does */ |
| 248 | udelay(20000); |
| 249 | /* set baud rate */ |
| 250 | writel(twsi_baud_rate, &twsi->baudrate); |
| 251 | /* set slave address even though we don't use it */ |
| 252 | writel(twsi_slave_address, &twsi->slave_address); |
| 253 | writel(0, &twsi->xtnd_slave_addr); |
| 254 | /* assert STOP but don't care for the result */ |
| 255 | (void) twsi_stop(0); |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 256 | } |
| 257 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 258 | /* |
| 259 | * I2C init called by cmd_i2c when doing 'i2c reset'. |
| 260 | * Sets baud to the highest possible value not exceeding requested one. |
| 261 | */ |
| 262 | void i2c_init(int requested_speed, int slaveadd) |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 263 | { |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 264 | int tmp_speed, highest_speed, n, m; |
| 265 | int baud = 0x44; /* baudrate at controller reset */ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 266 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 267 | /* use actual speed to collect progressively higher values */ |
| 268 | highest_speed = 0; |
| 269 | /* compute m, n setting for highest speed not above requested speed */ |
| 270 | for (n = 0; n < 8; n++) { |
| 271 | for (m = 0; m < 16; m++) { |
| 272 | tmp_speed = TWSI_FREQUENCY(m, n); |
| 273 | if ((tmp_speed <= requested_speed) |
| 274 | && (tmp_speed > highest_speed)) { |
| 275 | highest_speed = tmp_speed; |
| 276 | baud = (m << 3) | n; |
| 277 | } |
| 278 | } |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 279 | } |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 280 | /* save baud rate and slave for later calls to twsi_reset */ |
| 281 | twsi_baud_rate = baud; |
| 282 | twsi_actual_speed = highest_speed; |
| 283 | twsi_slave_address = slaveadd; |
| 284 | /* reset controller */ |
| 285 | twsi_reset(); |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 286 | } |
| 287 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 288 | /* |
| 289 | * Begin I2C transaction with expected start status, at given address. |
| 290 | * Common to i2c_probe, i2c_read and i2c_write. |
| 291 | * Expected address status will derive from direction bit (bit 0) in addr. |
| 292 | */ |
| 293 | static int i2c_begin(int expected_start_status, u8 addr) |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 294 | { |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 295 | int status, expected_addr_status; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 296 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 297 | /* compute expected address status from direction bit in addr */ |
| 298 | if (addr & 1) /* reading */ |
| 299 | expected_addr_status = MVTWSI_STATUS_ADDR_R_ACK; |
| 300 | else /* writing */ |
| 301 | expected_addr_status = MVTWSI_STATUS_ADDR_W_ACK; |
| 302 | /* assert START */ |
| 303 | status = twsi_start(expected_start_status); |
| 304 | /* send out the address if the start went well */ |
| 305 | if (status == 0) |
| 306 | status = twsi_send(addr, expected_addr_status); |
| 307 | /* return ok or status of first failure to caller */ |
| 308 | return status; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 309 | } |
| 310 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 311 | /* |
| 312 | * I2C probe called by cmd_i2c when doing 'i2c probe'. |
| 313 | * Begin read, nak data byte, end. |
| 314 | */ |
| 315 | int i2c_probe(uchar chip) |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 316 | { |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 317 | u8 dummy_byte; |
| 318 | int status; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 319 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 320 | /* begin i2c read */ |
| 321 | status = i2c_begin(MVTWSI_STATUS_START, (chip << 1) | 1); |
| 322 | /* dummy read was accepted: receive byte but NAK it. */ |
| 323 | if (status == 0) |
| 324 | status = twsi_recv(&dummy_byte); |
| 325 | /* Stop transaction */ |
| 326 | twsi_stop(0); |
| 327 | /* return 0 or status of first failure */ |
| 328 | return status; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 329 | } |
| 330 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 331 | /* |
| 332 | * I2C read called by cmd_i2c when doing 'i2c read' and by cmd_eeprom.c |
| 333 | * Begin write, send address byte(s), begin read, receive data bytes, end. |
| 334 | * |
| 335 | * NOTE: some EEPROMS want a stop right before the second start, while |
| 336 | * some will choke if it is there. Deciding which we should do is eeprom |
| 337 | * stuff, not i2c, but at the moment the APIs won't let us put it in |
| 338 | * cmd_eeprom, so we have to choose here, and for the moment that'll be |
| 339 | * a repeated start without a preceding stop. |
| 340 | */ |
| 341 | int i2c_read(u8 dev, uint addr, int alen, u8 *data, int length) |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 342 | { |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 343 | int status; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 344 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 345 | /* begin i2c write to send the address bytes */ |
| 346 | status = i2c_begin(MVTWSI_STATUS_START, (dev << 1)); |
| 347 | /* send addr bytes */ |
| 348 | while ((status == 0) && alen--) |
| 349 | status = twsi_send(addr >> (8*alen), |
| 350 | MVTWSI_STATUS_DATA_W_ACK); |
| 351 | /* begin i2c read to receive eeprom data bytes */ |
| 352 | if (status == 0) |
| 353 | status = i2c_begin( |
| 354 | MVTWSI_STATUS_REPEATED_START, (dev << 1) | 1); |
| 355 | /* prepare ACK if at least one byte must be received */ |
| 356 | if (length > 0) |
| 357 | twsi_control_flags |= MVTWSI_CONTROL_ACK; |
| 358 | /* now receive actual bytes */ |
| 359 | while ((status == 0) && length--) { |
| 360 | /* reset NAK if we if no more to read now */ |
| 361 | if (length == 0) |
| 362 | twsi_control_flags &= ~MVTWSI_CONTROL_ACK; |
| 363 | /* read current byte */ |
| 364 | status = twsi_recv(data++); |
| 365 | } |
| 366 | /* Stop transaction */ |
| 367 | status = twsi_stop(status); |
| 368 | /* return 0 or status of first failure */ |
| 369 | return status; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 370 | } |
| 371 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 372 | /* |
| 373 | * I2C write called by cmd_i2c when doing 'i2c write' and by cmd_eeprom.c |
| 374 | * Begin write, send address byte(s), send data bytes, end. |
| 375 | */ |
| 376 | int i2c_write(u8 dev, uint addr, int alen, u8 *data, int length) |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 377 | { |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 378 | int status; |
| 379 | |
| 380 | /* begin i2c write to send the eeprom adress bytes then data bytes */ |
| 381 | status = i2c_begin(MVTWSI_STATUS_START, (dev << 1)); |
| 382 | /* send addr bytes */ |
| 383 | while ((status == 0) && alen--) |
| 384 | status = twsi_send(addr >> (8*alen), |
| 385 | MVTWSI_STATUS_DATA_W_ACK); |
| 386 | /* send data bytes */ |
| 387 | while ((status == 0) && (length-- > 0)) |
| 388 | status = twsi_send(*(data++), MVTWSI_STATUS_DATA_W_ACK); |
| 389 | /* Stop transaction */ |
| 390 | status = twsi_stop(status); |
| 391 | /* return 0 or status of first failure */ |
| 392 | return status; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 393 | } |
| 394 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 395 | /* |
| 396 | * Bus set routine: we only support bus 0. |
| 397 | */ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 398 | int i2c_set_bus_num(unsigned int bus) |
| 399 | { |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 400 | if (bus > 0) { |
| 401 | return -1; |
| 402 | } |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 403 | return 0; |
| 404 | } |
| 405 | |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 406 | /* |
| 407 | * Bus get routine: hard-return bus 0. |
| 408 | */ |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 409 | unsigned int i2c_get_bus_num(void) |
| 410 | { |
Albert Aribaud | 04280c4 | 2010-08-27 18:26:05 +0200 | [diff] [blame] | 411 | return 0; |
Heiko Schocher | 5cd2a24 | 2009-07-20 09:59:37 +0200 | [diff] [blame] | 412 | } |