101ec99d9SAlbert Aribaud /* 2306563a7SAlbert Aribaud * Driver for the TWSI (i2c) controller found on the Marvell 3306563a7SAlbert Aribaud * orion5x and kirkwood SoC families. 401ec99d9SAlbert Aribaud * 5*57b4bce9SAlbert ARIBAUD * Author: Albert Aribaud <albert.u.boot@aribaud.net> 6306563a7SAlbert Aribaud * Copyright (c) 2010 Albert Aribaud. 701ec99d9SAlbert Aribaud * 801ec99d9SAlbert Aribaud * See file CREDITS for list of people who contributed to this 901ec99d9SAlbert Aribaud * project. 1001ec99d9SAlbert Aribaud * 1101ec99d9SAlbert Aribaud * This program is free software; you can redistribute it and/or 1201ec99d9SAlbert Aribaud * modify it under the terms of the GNU General Public License as 1301ec99d9SAlbert Aribaud * published by the Free Software Foundation; either version 2 of 1401ec99d9SAlbert Aribaud * the License, or (at your option) any later version. 1501ec99d9SAlbert Aribaud * 1601ec99d9SAlbert Aribaud * This program is distributed in the hope that it will be useful, 1701ec99d9SAlbert Aribaud * but WITHOUT ANY WARRANTY; without even the implied warranty of 1801ec99d9SAlbert Aribaud * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1901ec99d9SAlbert Aribaud * GNU General Public License for more details. 2001ec99d9SAlbert Aribaud * 2101ec99d9SAlbert Aribaud * You should have received a copy of the GNU General Public License 2201ec99d9SAlbert Aribaud * along with this program; if not, write to the Free Software 2301ec99d9SAlbert Aribaud * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, 2401ec99d9SAlbert Aribaud * MA 02110-1301 USA 2501ec99d9SAlbert Aribaud */ 26306563a7SAlbert Aribaud 2701ec99d9SAlbert Aribaud #include <common.h> 2801ec99d9SAlbert Aribaud #include <i2c.h> 2901ec99d9SAlbert Aribaud #include <asm/errno.h> 3001ec99d9SAlbert Aribaud #include <asm/io.h> 3101ec99d9SAlbert Aribaud 32306563a7SAlbert Aribaud /* 33306563a7SAlbert Aribaud * include a file that will provide CONFIG_I2C_MVTWSI_BASE 34306563a7SAlbert Aribaud * and possibly other settings 35306563a7SAlbert Aribaud */ 3601ec99d9SAlbert Aribaud 37306563a7SAlbert Aribaud #if defined(CONFIG_ORION5X) 38306563a7SAlbert Aribaud #include <asm/arch/orion5x.h> 39306563a7SAlbert Aribaud #elif defined(CONFIG_KIRKWOOD) 40306563a7SAlbert Aribaud #include <asm/arch/kirkwood.h> 41306563a7SAlbert Aribaud #else 42306563a7SAlbert Aribaud #error Driver mvtwsi not supported by SoC or board 4301ec99d9SAlbert Aribaud #endif 4401ec99d9SAlbert Aribaud 4501ec99d9SAlbert Aribaud /* 46306563a7SAlbert Aribaud * TWSI register structure 4701ec99d9SAlbert Aribaud */ 4801ec99d9SAlbert Aribaud 49306563a7SAlbert Aribaud struct mvtwsi_registers { 50306563a7SAlbert Aribaud u32 slave_address; 51306563a7SAlbert Aribaud u32 data; 52306563a7SAlbert Aribaud u32 control; 53306563a7SAlbert Aribaud union { 54306563a7SAlbert Aribaud u32 status; /* when reading */ 55306563a7SAlbert Aribaud u32 baudrate; /* when writing */ 56306563a7SAlbert Aribaud }; 57306563a7SAlbert Aribaud u32 xtnd_slave_addr; 58306563a7SAlbert Aribaud u32 reserved[2]; 59306563a7SAlbert Aribaud u32 soft_reset; 60306563a7SAlbert Aribaud }; 61306563a7SAlbert Aribaud 62306563a7SAlbert Aribaud /* 63306563a7SAlbert Aribaud * Control register fields 64306563a7SAlbert Aribaud */ 65306563a7SAlbert Aribaud 66306563a7SAlbert Aribaud #define MVTWSI_CONTROL_ACK 0x00000004 67306563a7SAlbert Aribaud #define MVTWSI_CONTROL_IFLG 0x00000008 68306563a7SAlbert Aribaud #define MVTWSI_CONTROL_STOP 0x00000010 69306563a7SAlbert Aribaud #define MVTWSI_CONTROL_START 0x00000020 70306563a7SAlbert Aribaud #define MVTWSI_CONTROL_TWSIEN 0x00000040 71306563a7SAlbert Aribaud #define MVTWSI_CONTROL_INTEN 0x00000080 72306563a7SAlbert Aribaud 73306563a7SAlbert Aribaud /* 74306563a7SAlbert Aribaud * Status register values -- only those expected in normal master 75306563a7SAlbert Aribaud * operation on non-10-bit-address devices; whatever status we don't 76306563a7SAlbert Aribaud * expect in nominal conditions (bus errors, arbitration losses, 77306563a7SAlbert Aribaud * missing ACKs...) we just pass back to the caller as an error 78306563a7SAlbert Aribaud * code. 79306563a7SAlbert Aribaud */ 80306563a7SAlbert Aribaud 81306563a7SAlbert Aribaud #define MVTWSI_STATUS_START 0x08 82306563a7SAlbert Aribaud #define MVTWSI_STATUS_REPEATED_START 0x10 83306563a7SAlbert Aribaud #define MVTWSI_STATUS_ADDR_W_ACK 0x18 84306563a7SAlbert Aribaud #define MVTWSI_STATUS_DATA_W_ACK 0x28 85306563a7SAlbert Aribaud #define MVTWSI_STATUS_ADDR_R_ACK 0x40 86306563a7SAlbert Aribaud #define MVTWSI_STATUS_ADDR_R_NAK 0x48 87306563a7SAlbert Aribaud #define MVTWSI_STATUS_DATA_R_ACK 0x50 88306563a7SAlbert Aribaud #define MVTWSI_STATUS_DATA_R_NAK 0x58 89306563a7SAlbert Aribaud #define MVTWSI_STATUS_IDLE 0xF8 90306563a7SAlbert Aribaud 91306563a7SAlbert Aribaud /* 92306563a7SAlbert Aribaud * The single instance of the controller we'll be dealing with 93306563a7SAlbert Aribaud */ 94306563a7SAlbert Aribaud 95306563a7SAlbert Aribaud static struct mvtwsi_registers *twsi = 96306563a7SAlbert Aribaud (struct mvtwsi_registers *) CONFIG_I2C_MVTWSI_BASE; 97306563a7SAlbert Aribaud 98306563a7SAlbert Aribaud /* 99306563a7SAlbert Aribaud * Returned statuses are 0 for success and nonzero otherwise. 100306563a7SAlbert Aribaud * Currently, cmd_i2c and cmd_eeprom do not interpret an error status. 101306563a7SAlbert Aribaud * Thus to ease debugging, the return status contains some debug info: 102306563a7SAlbert Aribaud * - bits 31..24 are error class: 1 is timeout, 2 is 'status mismatch'. 103306563a7SAlbert Aribaud * - bits 23..16 are the last value of the control register. 104306563a7SAlbert Aribaud * - bits 15..8 are the last value of the status register. 105306563a7SAlbert Aribaud * - bits 7..0 are the expected value of the status register. 106306563a7SAlbert Aribaud */ 107306563a7SAlbert Aribaud 108306563a7SAlbert Aribaud #define MVTWSI_ERROR_WRONG_STATUS 0x01 109306563a7SAlbert Aribaud #define MVTWSI_ERROR_TIMEOUT 0x02 110306563a7SAlbert Aribaud 111306563a7SAlbert Aribaud #define MVTWSI_ERROR(ec, lc, ls, es) (((ec << 24) & 0xFF000000) | \ 112306563a7SAlbert Aribaud ((lc << 16) & 0x00FF0000) | ((ls<<8) & 0x0000FF00) | (es & 0xFF)) 113306563a7SAlbert Aribaud 114306563a7SAlbert Aribaud /* 115306563a7SAlbert Aribaud * Wait for IFLG to raise, or return 'timeout'; then if status is as expected, 116306563a7SAlbert Aribaud * return 0 (ok) or return 'wrong status'. 117306563a7SAlbert Aribaud */ 118306563a7SAlbert Aribaud static int twsi_wait(int expected_status) 11901ec99d9SAlbert Aribaud { 120306563a7SAlbert Aribaud int control, status; 121306563a7SAlbert Aribaud int timeout = 1000; 122306563a7SAlbert Aribaud 123306563a7SAlbert Aribaud do { 124306563a7SAlbert Aribaud control = readl(&twsi->control); 125306563a7SAlbert Aribaud if (control & MVTWSI_CONTROL_IFLG) { 126306563a7SAlbert Aribaud status = readl(&twsi->status); 127306563a7SAlbert Aribaud if (status == expected_status) 128306563a7SAlbert Aribaud return 0; 12901ec99d9SAlbert Aribaud else 130306563a7SAlbert Aribaud return MVTWSI_ERROR( 131306563a7SAlbert Aribaud MVTWSI_ERROR_WRONG_STATUS, 132306563a7SAlbert Aribaud control, status, expected_status); 133306563a7SAlbert Aribaud } 134306563a7SAlbert Aribaud udelay(10); /* one clock cycle at 100 kHz */ 135306563a7SAlbert Aribaud } while (timeout--); 136306563a7SAlbert Aribaud status = readl(&twsi->status); 137306563a7SAlbert Aribaud return MVTWSI_ERROR( 138306563a7SAlbert Aribaud MVTWSI_ERROR_TIMEOUT, control, status, expected_status); 13901ec99d9SAlbert Aribaud } 14001ec99d9SAlbert Aribaud 141306563a7SAlbert Aribaud /* 142306563a7SAlbert Aribaud * These flags are ORed to any write to the control register 143306563a7SAlbert Aribaud * They allow global setting of TWSIEN and ACK. 144306563a7SAlbert Aribaud * By default none are set. 145306563a7SAlbert Aribaud * twsi_start() sets TWSIEN (in case the controller was disabled) 146306563a7SAlbert Aribaud * twsi_recv() sets ACK or resets it depending on expected status. 147306563a7SAlbert Aribaud */ 148306563a7SAlbert Aribaud static u8 twsi_control_flags = MVTWSI_CONTROL_TWSIEN; 14901ec99d9SAlbert Aribaud 150306563a7SAlbert Aribaud /* 151306563a7SAlbert Aribaud * Assert the START condition, either in a single I2C transaction 152306563a7SAlbert Aribaud * or inside back-to-back ones (repeated starts). 153306563a7SAlbert Aribaud */ 154306563a7SAlbert Aribaud static int twsi_start(int expected_status) 155306563a7SAlbert Aribaud { 156306563a7SAlbert Aribaud /* globally set TWSIEN in case it was not */ 157306563a7SAlbert Aribaud twsi_control_flags |= MVTWSI_CONTROL_TWSIEN; 158306563a7SAlbert Aribaud /* assert START */ 159306563a7SAlbert Aribaud writel(twsi_control_flags | MVTWSI_CONTROL_START, &twsi->control); 160306563a7SAlbert Aribaud /* wait for controller to process START */ 161306563a7SAlbert Aribaud return twsi_wait(expected_status); 162306563a7SAlbert Aribaud } 163306563a7SAlbert Aribaud 164306563a7SAlbert Aribaud /* 165306563a7SAlbert Aribaud * Send a byte (i2c address or data). 166306563a7SAlbert Aribaud */ 167306563a7SAlbert Aribaud static int twsi_send(u8 byte, int expected_status) 168306563a7SAlbert Aribaud { 169306563a7SAlbert Aribaud /* put byte in data register for sending */ 170306563a7SAlbert Aribaud writel(byte, &twsi->data); 171306563a7SAlbert Aribaud /* clear any pending interrupt -- that'll cause sending */ 172306563a7SAlbert Aribaud writel(twsi_control_flags, &twsi->control); 173306563a7SAlbert Aribaud /* wait for controller to receive byte and check ACK */ 174306563a7SAlbert Aribaud return twsi_wait(expected_status); 175306563a7SAlbert Aribaud } 176306563a7SAlbert Aribaud 177306563a7SAlbert Aribaud /* 178306563a7SAlbert Aribaud * Receive a byte. 179306563a7SAlbert Aribaud * Global mvtwsi_control_flags variable says if we should ack or nak. 180306563a7SAlbert Aribaud */ 181306563a7SAlbert Aribaud static int twsi_recv(u8 *byte) 182306563a7SAlbert Aribaud { 183306563a7SAlbert Aribaud int expected_status, status; 184306563a7SAlbert Aribaud 185306563a7SAlbert Aribaud /* compute expected status based on ACK bit in global control flags */ 186306563a7SAlbert Aribaud if (twsi_control_flags & MVTWSI_CONTROL_ACK) 187306563a7SAlbert Aribaud expected_status = MVTWSI_STATUS_DATA_R_ACK; 188306563a7SAlbert Aribaud else 189306563a7SAlbert Aribaud expected_status = MVTWSI_STATUS_DATA_R_NAK; 190306563a7SAlbert Aribaud /* acknowledge *previous state* and launch receive */ 191306563a7SAlbert Aribaud writel(twsi_control_flags, &twsi->control); 192306563a7SAlbert Aribaud /* wait for controller to receive byte and assert ACK or NAK */ 193306563a7SAlbert Aribaud status = twsi_wait(expected_status); 194306563a7SAlbert Aribaud /* if we did receive expected byte then store it */ 195306563a7SAlbert Aribaud if (status == 0) 196306563a7SAlbert Aribaud *byte = readl(&twsi->data); 197306563a7SAlbert Aribaud /* return status */ 198306563a7SAlbert Aribaud return status; 199306563a7SAlbert Aribaud } 200306563a7SAlbert Aribaud 201306563a7SAlbert Aribaud /* 202306563a7SAlbert Aribaud * Assert the STOP condition. 203306563a7SAlbert Aribaud * This is also used to force the bus back in idle (SDA=SCL=1). 204306563a7SAlbert Aribaud */ 205306563a7SAlbert Aribaud static int twsi_stop(int status) 206306563a7SAlbert Aribaud { 207306563a7SAlbert Aribaud int control, stop_status; 208306563a7SAlbert Aribaud int timeout = 1000; 209306563a7SAlbert Aribaud 210306563a7SAlbert Aribaud /* assert STOP */ 211306563a7SAlbert Aribaud control = MVTWSI_CONTROL_TWSIEN | MVTWSI_CONTROL_STOP; 212306563a7SAlbert Aribaud writel(control, &twsi->control); 213306563a7SAlbert Aribaud /* wait for IDLE; IFLG won't rise so twsi_wait() is no use. */ 214306563a7SAlbert Aribaud do { 215306563a7SAlbert Aribaud stop_status = readl(&twsi->status); 216306563a7SAlbert Aribaud if (stop_status == MVTWSI_STATUS_IDLE) 217306563a7SAlbert Aribaud break; 218306563a7SAlbert Aribaud udelay(10); /* one clock cycle at 100 kHz */ 219306563a7SAlbert Aribaud } while (timeout--); 220306563a7SAlbert Aribaud control = readl(&twsi->control); 221306563a7SAlbert Aribaud if (stop_status != MVTWSI_STATUS_IDLE) 222306563a7SAlbert Aribaud if (status == 0) 223306563a7SAlbert Aribaud status = MVTWSI_ERROR( 224306563a7SAlbert Aribaud MVTWSI_ERROR_TIMEOUT, 225306563a7SAlbert Aribaud control, status, MVTWSI_STATUS_IDLE); 226306563a7SAlbert Aribaud return status; 227306563a7SAlbert Aribaud } 228306563a7SAlbert Aribaud 229306563a7SAlbert Aribaud /* 230306563a7SAlbert Aribaud * Ugly formula to convert m and n values to a frequency comes from 231306563a7SAlbert Aribaud * TWSI specifications 232306563a7SAlbert Aribaud */ 233306563a7SAlbert Aribaud 234306563a7SAlbert Aribaud #define TWSI_FREQUENCY(m, n) \ 235306563a7SAlbert Aribaud ((u8) (CONFIG_SYS_TCLK / (10 * (m + 1) * 2 * (1 << n)))) 236306563a7SAlbert Aribaud 237306563a7SAlbert Aribaud /* 238306563a7SAlbert Aribaud * These are required to be reprogrammed before enabling the controller 239306563a7SAlbert Aribaud * because a reset loses them. 240306563a7SAlbert Aribaud * Default values come from the spec, but a twsi_reset will change them. 241306563a7SAlbert Aribaud * twsi_slave_address left uninitialized lest checkpatch.pl complains. 242306563a7SAlbert Aribaud */ 243306563a7SAlbert Aribaud 244306563a7SAlbert Aribaud /* Baudrate generator: m (bits 7..4) =4, n (bits 3..0) =4 */ 245306563a7SAlbert Aribaud static u8 twsi_baud_rate = 0x44; /* baudrate at controller reset */ 246306563a7SAlbert Aribaud /* Default frequency corresponding to default m=4, n=4 */ 247306563a7SAlbert Aribaud static u8 twsi_actual_speed = TWSI_FREQUENCY(4, 4); 248306563a7SAlbert Aribaud /* Default slave address is 0 (so is an uninitialized static) */ 249306563a7SAlbert Aribaud static u8 twsi_slave_address; 250306563a7SAlbert Aribaud 251306563a7SAlbert Aribaud /* 252306563a7SAlbert Aribaud * Reset controller. 253306563a7SAlbert Aribaud * Called at end of i2c_init unsuccessful i2c transactions. 254306563a7SAlbert Aribaud * Controller reset also resets the baud rate and slave address, so 255306563a7SAlbert Aribaud * re-establish them. 256306563a7SAlbert Aribaud */ 257306563a7SAlbert Aribaud static void twsi_reset(void) 258306563a7SAlbert Aribaud { 259306563a7SAlbert Aribaud /* ensure controller will be enabled by any twsi*() function */ 260306563a7SAlbert Aribaud twsi_control_flags = MVTWSI_CONTROL_TWSIEN; 261306563a7SAlbert Aribaud /* reset controller */ 262306563a7SAlbert Aribaud writel(0, &twsi->soft_reset); 263306563a7SAlbert Aribaud /* wait 2 ms -- this is what the Marvell LSP does */ 264306563a7SAlbert Aribaud udelay(20000); 265306563a7SAlbert Aribaud /* set baud rate */ 266306563a7SAlbert Aribaud writel(twsi_baud_rate, &twsi->baudrate); 267306563a7SAlbert Aribaud /* set slave address even though we don't use it */ 268306563a7SAlbert Aribaud writel(twsi_slave_address, &twsi->slave_address); 269306563a7SAlbert Aribaud writel(0, &twsi->xtnd_slave_addr); 270306563a7SAlbert Aribaud /* assert STOP but don't care for the result */ 271306563a7SAlbert Aribaud (void) twsi_stop(0); 272306563a7SAlbert Aribaud } 273306563a7SAlbert Aribaud 274306563a7SAlbert Aribaud /* 275306563a7SAlbert Aribaud * I2C init called by cmd_i2c when doing 'i2c reset'. 276306563a7SAlbert Aribaud * Sets baud to the highest possible value not exceeding requested one. 277306563a7SAlbert Aribaud */ 278306563a7SAlbert Aribaud void i2c_init(int requested_speed, int slaveadd) 279306563a7SAlbert Aribaud { 280306563a7SAlbert Aribaud int tmp_speed, highest_speed, n, m; 281306563a7SAlbert Aribaud int baud = 0x44; /* baudrate at controller reset */ 282306563a7SAlbert Aribaud 283306563a7SAlbert Aribaud /* use actual speed to collect progressively higher values */ 284306563a7SAlbert Aribaud highest_speed = 0; 285306563a7SAlbert Aribaud /* compute m, n setting for highest speed not above requested speed */ 28601ec99d9SAlbert Aribaud for (n = 0; n < 8; n++) { 28701ec99d9SAlbert Aribaud for (m = 0; m < 16; m++) { 288306563a7SAlbert Aribaud tmp_speed = TWSI_FREQUENCY(m, n); 289306563a7SAlbert Aribaud if ((tmp_speed <= requested_speed) 290306563a7SAlbert Aribaud && (tmp_speed > highest_speed)) { 291306563a7SAlbert Aribaud highest_speed = tmp_speed; 292306563a7SAlbert Aribaud baud = (m << 3) | n; 29301ec99d9SAlbert Aribaud } 29401ec99d9SAlbert Aribaud } 29501ec99d9SAlbert Aribaud } 296306563a7SAlbert Aribaud /* save baud rate and slave for later calls to twsi_reset */ 297306563a7SAlbert Aribaud twsi_baud_rate = baud; 298306563a7SAlbert Aribaud twsi_actual_speed = highest_speed; 299306563a7SAlbert Aribaud twsi_slave_address = slaveadd; 300306563a7SAlbert Aribaud /* reset controller */ 301306563a7SAlbert Aribaud twsi_reset(); 30201ec99d9SAlbert Aribaud } 30301ec99d9SAlbert Aribaud 30401ec99d9SAlbert Aribaud /* 305306563a7SAlbert Aribaud * Begin I2C transaction with expected start status, at given address. 306306563a7SAlbert Aribaud * Common to i2c_probe, i2c_read and i2c_write. 307306563a7SAlbert Aribaud * Expected address status will derive from direction bit (bit 0) in addr. 30801ec99d9SAlbert Aribaud */ 309306563a7SAlbert Aribaud static int i2c_begin(int expected_start_status, u8 addr) 31001ec99d9SAlbert Aribaud { 311306563a7SAlbert Aribaud int status, expected_addr_status; 31201ec99d9SAlbert Aribaud 313306563a7SAlbert Aribaud /* compute expected address status from direction bit in addr */ 314306563a7SAlbert Aribaud if (addr & 1) /* reading */ 315306563a7SAlbert Aribaud expected_addr_status = MVTWSI_STATUS_ADDR_R_ACK; 316306563a7SAlbert Aribaud else /* writing */ 317306563a7SAlbert Aribaud expected_addr_status = MVTWSI_STATUS_ADDR_W_ACK; 318306563a7SAlbert Aribaud /* assert START */ 319306563a7SAlbert Aribaud status = twsi_start(expected_start_status); 320306563a7SAlbert Aribaud /* send out the address if the start went well */ 321306563a7SAlbert Aribaud if (status == 0) 322306563a7SAlbert Aribaud status = twsi_send(addr, expected_addr_status); 323306563a7SAlbert Aribaud /* return ok or status of first failure to caller */ 324306563a7SAlbert Aribaud return status; 32501ec99d9SAlbert Aribaud } 32601ec99d9SAlbert Aribaud 327306563a7SAlbert Aribaud /* 328306563a7SAlbert Aribaud * I2C probe called by cmd_i2c when doing 'i2c probe'. 329306563a7SAlbert Aribaud * Begin read, nak data byte, end. 330306563a7SAlbert Aribaud */ 331306563a7SAlbert Aribaud int i2c_probe(uchar chip) 33201ec99d9SAlbert Aribaud { 333306563a7SAlbert Aribaud u8 dummy_byte; 334306563a7SAlbert Aribaud int status; 33501ec99d9SAlbert Aribaud 336306563a7SAlbert Aribaud /* begin i2c read */ 337306563a7SAlbert Aribaud status = i2c_begin(MVTWSI_STATUS_START, (chip << 1) | 1); 338306563a7SAlbert Aribaud /* dummy read was accepted: receive byte but NAK it. */ 339306563a7SAlbert Aribaud if (status == 0) 340306563a7SAlbert Aribaud status = twsi_recv(&dummy_byte); 341306563a7SAlbert Aribaud /* Stop transaction */ 342306563a7SAlbert Aribaud twsi_stop(0); 343306563a7SAlbert Aribaud /* return 0 or status of first failure */ 344306563a7SAlbert Aribaud return status; 34501ec99d9SAlbert Aribaud } 34601ec99d9SAlbert Aribaud 347306563a7SAlbert Aribaud /* 348306563a7SAlbert Aribaud * I2C read called by cmd_i2c when doing 'i2c read' and by cmd_eeprom.c 349306563a7SAlbert Aribaud * Begin write, send address byte(s), begin read, receive data bytes, end. 350306563a7SAlbert Aribaud * 351306563a7SAlbert Aribaud * NOTE: some EEPROMS want a stop right before the second start, while 352306563a7SAlbert Aribaud * some will choke if it is there. Deciding which we should do is eeprom 353306563a7SAlbert Aribaud * stuff, not i2c, but at the moment the APIs won't let us put it in 354306563a7SAlbert Aribaud * cmd_eeprom, so we have to choose here, and for the moment that'll be 355306563a7SAlbert Aribaud * a repeated start without a preceding stop. 356306563a7SAlbert Aribaud */ 357306563a7SAlbert Aribaud int i2c_read(u8 dev, uint addr, int alen, u8 *data, int length) 35801ec99d9SAlbert Aribaud { 359306563a7SAlbert Aribaud int status; 36001ec99d9SAlbert Aribaud 361306563a7SAlbert Aribaud /* begin i2c write to send the address bytes */ 362306563a7SAlbert Aribaud status = i2c_begin(MVTWSI_STATUS_START, (dev << 1)); 363306563a7SAlbert Aribaud /* send addr bytes */ 364306563a7SAlbert Aribaud while ((status == 0) && alen--) 365306563a7SAlbert Aribaud status = twsi_send(addr >> (8*alen), 366306563a7SAlbert Aribaud MVTWSI_STATUS_DATA_W_ACK); 367306563a7SAlbert Aribaud /* begin i2c read to receive eeprom data bytes */ 368306563a7SAlbert Aribaud if (status == 0) 369306563a7SAlbert Aribaud status = i2c_begin( 370306563a7SAlbert Aribaud MVTWSI_STATUS_REPEATED_START, (dev << 1) | 1); 371306563a7SAlbert Aribaud /* prepare ACK if at least one byte must be received */ 372306563a7SAlbert Aribaud if (length > 0) 373306563a7SAlbert Aribaud twsi_control_flags |= MVTWSI_CONTROL_ACK; 374306563a7SAlbert Aribaud /* now receive actual bytes */ 375306563a7SAlbert Aribaud while ((status == 0) && length--) { 376306563a7SAlbert Aribaud /* reset NAK if we if no more to read now */ 377306563a7SAlbert Aribaud if (length == 0) 378306563a7SAlbert Aribaud twsi_control_flags &= ~MVTWSI_CONTROL_ACK; 379306563a7SAlbert Aribaud /* read current byte */ 380306563a7SAlbert Aribaud status = twsi_recv(data++); 38101ec99d9SAlbert Aribaud } 382306563a7SAlbert Aribaud /* Stop transaction */ 383306563a7SAlbert Aribaud status = twsi_stop(status); 384306563a7SAlbert Aribaud /* return 0 or status of first failure */ 385306563a7SAlbert Aribaud return status; 38601ec99d9SAlbert Aribaud } 38701ec99d9SAlbert Aribaud 388306563a7SAlbert Aribaud /* 389306563a7SAlbert Aribaud * I2C write called by cmd_i2c when doing 'i2c write' and by cmd_eeprom.c 390306563a7SAlbert Aribaud * Begin write, send address byte(s), send data bytes, end. 391306563a7SAlbert Aribaud */ 392306563a7SAlbert Aribaud int i2c_write(u8 dev, uint addr, int alen, u8 *data, int length) 39301ec99d9SAlbert Aribaud { 394306563a7SAlbert Aribaud int status; 39501ec99d9SAlbert Aribaud 396306563a7SAlbert Aribaud /* begin i2c write to send the eeprom adress bytes then data bytes */ 397306563a7SAlbert Aribaud status = i2c_begin(MVTWSI_STATUS_START, (dev << 1)); 398306563a7SAlbert Aribaud /* send addr bytes */ 399306563a7SAlbert Aribaud while ((status == 0) && alen--) 400306563a7SAlbert Aribaud status = twsi_send(addr >> (8*alen), 401306563a7SAlbert Aribaud MVTWSI_STATUS_DATA_W_ACK); 402306563a7SAlbert Aribaud /* send data bytes */ 403306563a7SAlbert Aribaud while ((status == 0) && (length-- > 0)) 404306563a7SAlbert Aribaud status = twsi_send(*(data++), MVTWSI_STATUS_DATA_W_ACK); 405306563a7SAlbert Aribaud /* Stop transaction */ 406306563a7SAlbert Aribaud status = twsi_stop(status); 407306563a7SAlbert Aribaud /* return 0 or status of first failure */ 408306563a7SAlbert Aribaud return status; 40901ec99d9SAlbert Aribaud } 41001ec99d9SAlbert Aribaud 411306563a7SAlbert Aribaud /* 412306563a7SAlbert Aribaud * Bus set routine: we only support bus 0. 413306563a7SAlbert Aribaud */ 41401ec99d9SAlbert Aribaud int i2c_set_bus_num(unsigned int bus) 41501ec99d9SAlbert Aribaud { 41601ec99d9SAlbert Aribaud if (bus > 0) { 41701ec99d9SAlbert Aribaud return -1; 41801ec99d9SAlbert Aribaud } 41901ec99d9SAlbert Aribaud return 0; 42001ec99d9SAlbert Aribaud } 42101ec99d9SAlbert Aribaud 422306563a7SAlbert Aribaud /* 423306563a7SAlbert Aribaud * Bus get routine: hard-return bus 0. 424306563a7SAlbert Aribaud */ 42501ec99d9SAlbert Aribaud unsigned int i2c_get_bus_num(void) 42601ec99d9SAlbert Aribaud { 427306563a7SAlbert Aribaud return 0; 42801ec99d9SAlbert Aribaud } 429