| 
									
										
										
										
											2010-05-23 21:44:54 -07:00
										 |  |  | /*
 | 
					
						
							| 
									
										
										
										
											2012-07-19 13:04:25 +00:00
										 |  |  |  * Copyright (c) 2012 Intel Corporation. All rights reserved. | 
					
						
							|  |  |  |  * Copyright (c) 2006 - 2012 QLogic Corporation. All rights reserved. | 
					
						
							| 
									
										
										
										
											2010-05-23 21:44:54 -07:00
										 |  |  |  * Copyright (c) 2003, 2004, 2005, 2006 PathScale, Inc. All rights reserved. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This software is available to you under a choice of one of two | 
					
						
							|  |  |  |  * licenses.  You may choose to be licensed under the terms of the GNU | 
					
						
							|  |  |  |  * General Public License (GPL) Version 2, available from the file | 
					
						
							|  |  |  |  * COPYING in the main directory of this source tree, or the | 
					
						
							|  |  |  |  * OpenIB.org BSD license below: | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *     Redistribution and use in source and binary forms, with or | 
					
						
							|  |  |  |  *     without modification, are permitted provided that the following | 
					
						
							|  |  |  |  *     conditions are met: | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *      - Redistributions of source code must retain the above | 
					
						
							|  |  |  |  *        copyright notice, this list of conditions and the following | 
					
						
							|  |  |  |  *        disclaimer. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *      - Redistributions in binary form must reproduce the above | 
					
						
							|  |  |  |  *        copyright notice, this list of conditions and the following | 
					
						
							|  |  |  |  *        disclaimer in the documentation and/or other materials | 
					
						
							|  |  |  |  *        provided with the distribution. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, | 
					
						
							|  |  |  |  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF | 
					
						
							|  |  |  |  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND | 
					
						
							|  |  |  |  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS | 
					
						
							|  |  |  |  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN | 
					
						
							|  |  |  |  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN | 
					
						
							|  |  |  |  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE | 
					
						
							|  |  |  |  * SOFTWARE. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include <linux/delay.h>
 | 
					
						
							|  |  |  | #include <linux/pci.h>
 | 
					
						
							|  |  |  | #include <linux/vmalloc.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include "qib.h"
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * QLogic_IB "Two Wire Serial Interface" driver. | 
					
						
							|  |  |  |  * Originally written for a not-quite-i2c serial eeprom, which is | 
					
						
							|  |  |  |  * still used on some supported boards. Later boards have added a | 
					
						
							| 
									
										
										
										
											2011-03-30 22:57:33 -03:00
										 |  |  |  * variety of other uses, most board-specific, so the bit-boffing | 
					
						
							| 
									
										
										
										
											2010-05-23 21:44:54 -07:00
										 |  |  |  * part has been split off to this file, while the other parts | 
					
						
							|  |  |  |  * have been moved to chip-specific files. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * We have also dropped all pretense of fully generic (e.g. pretend | 
					
						
							|  |  |  |  * we don't know whether '1' is the higher voltage) interface, as | 
					
						
							|  |  |  |  * the restrictions of the generic i2c interface (e.g. no access from | 
					
						
							|  |  |  |  * driver itself) make it unsuitable for this use. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define READ_CMD 1
 | 
					
						
							|  |  |  | #define WRITE_CMD 0
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * i2c_wait_for_writes - wait for a write | 
					
						
							|  |  |  |  * @dd: the qlogic_ib device | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * We use this instead of udelay directly, so we can make sure | 
					
						
							|  |  |  |  * that previous register writes have been flushed all the way | 
					
						
							|  |  |  |  * to the chip.  Since we are delaying anyway, the cost doesn't | 
					
						
							|  |  |  |  * hurt, and makes the bit twiddling more regular | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void i2c_wait_for_writes(struct qib_devdata *dd) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * implicit read of EXTStatus is as good as explicit | 
					
						
							|  |  |  | 	 * read of scratch, if all we want to do is flush | 
					
						
							|  |  |  | 	 * writes. | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	dd->f_gpio_mod(dd, 0, 0, 0); | 
					
						
							|  |  |  | 	rmb(); /* inlined, so prevent compiler reordering */ | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * QSFP modules are allowed to hold SCL low for 500uSec. Allow twice that | 
					
						
							|  |  |  |  * for "almost compliant" modules | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | #define SCL_WAIT_USEC 1000
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* BUF_WAIT is time bus must be free between STOP or ACK and to next START.
 | 
					
						
							|  |  |  |  * Should be 20, but some chips need more. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | #define TWSI_BUF_WAIT_USEC 60
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void scl_out(struct qib_devdata *dd, u8 bit) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	u32 mask; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	udelay(1); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	mask = 1UL << dd->gpio_scl_num; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* SCL is meant to be bare-drain, so never set "OUT", just DIR */ | 
					
						
							|  |  |  | 	dd->f_gpio_mod(dd, 0, bit ? 0 : mask, mask); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * Allow for slow slaves by simple | 
					
						
							|  |  |  | 	 * delay for falling edge, sampling on rise. | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	if (!bit) | 
					
						
							|  |  |  | 		udelay(2); | 
					
						
							|  |  |  | 	else { | 
					
						
							|  |  |  | 		int rise_usec; | 
					
						
							|  |  |  | 		for (rise_usec = SCL_WAIT_USEC; rise_usec > 0; rise_usec -= 2) { | 
					
						
							|  |  |  | 			if (mask & dd->f_gpio_mod(dd, 0, 0, 0)) | 
					
						
							|  |  |  | 				break; | 
					
						
							|  |  |  | 			udelay(2); | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		if (rise_usec <= 0) | 
					
						
							|  |  |  | 			qib_dev_err(dd, "SCL interface stuck low > %d uSec\n", | 
					
						
							|  |  |  | 				    SCL_WAIT_USEC); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	i2c_wait_for_writes(dd); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void sda_out(struct qib_devdata *dd, u8 bit) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	u32 mask; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	mask = 1UL << dd->gpio_sda_num; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* SDA is meant to be bare-drain, so never set "OUT", just DIR */ | 
					
						
							|  |  |  | 	dd->f_gpio_mod(dd, 0, bit ? 0 : mask, mask); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	i2c_wait_for_writes(dd); | 
					
						
							|  |  |  | 	udelay(2); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static u8 sda_in(struct qib_devdata *dd, int wait) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int bnum; | 
					
						
							|  |  |  | 	u32 read_val, mask; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	bnum = dd->gpio_sda_num; | 
					
						
							|  |  |  | 	mask = (1UL << bnum); | 
					
						
							|  |  |  | 	/* SDA is meant to be bare-drain, so never set "OUT", just DIR */ | 
					
						
							|  |  |  | 	dd->f_gpio_mod(dd, 0, 0, mask); | 
					
						
							|  |  |  | 	read_val = dd->f_gpio_mod(dd, 0, 0, 0); | 
					
						
							|  |  |  | 	if (wait) | 
					
						
							|  |  |  | 		i2c_wait_for_writes(dd); | 
					
						
							|  |  |  | 	return (read_val & mask) >> bnum; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * i2c_ackrcv - see if ack following write is true | 
					
						
							|  |  |  |  * @dd: the qlogic_ib device | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int i2c_ackrcv(struct qib_devdata *dd) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	u8 ack_received; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* AT ENTRY SCL = LOW */ | 
					
						
							|  |  |  | 	/* change direction, ignore data */ | 
					
						
							|  |  |  | 	ack_received = sda_in(dd, 1); | 
					
						
							|  |  |  | 	scl_out(dd, 1); | 
					
						
							|  |  |  | 	ack_received = sda_in(dd, 1) == 0; | 
					
						
							|  |  |  | 	scl_out(dd, 0); | 
					
						
							|  |  |  | 	return ack_received; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void stop_cmd(struct qib_devdata *dd); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * rd_byte - read a byte, sending STOP on last, else ACK | 
					
						
							|  |  |  |  * @dd: the qlogic_ib device | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Returns byte shifted out of device | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int rd_byte(struct qib_devdata *dd, int last) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int bit_cntr, data; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	data = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	for (bit_cntr = 7; bit_cntr >= 0; --bit_cntr) { | 
					
						
							|  |  |  | 		data <<= 1; | 
					
						
							|  |  |  | 		scl_out(dd, 1); | 
					
						
							|  |  |  | 		data |= sda_in(dd, 0); | 
					
						
							|  |  |  | 		scl_out(dd, 0); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	if (last) { | 
					
						
							|  |  |  | 		scl_out(dd, 1); | 
					
						
							|  |  |  | 		stop_cmd(dd); | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		sda_out(dd, 0); | 
					
						
							|  |  |  | 		scl_out(dd, 1); | 
					
						
							|  |  |  | 		scl_out(dd, 0); | 
					
						
							|  |  |  | 		sda_out(dd, 1); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	return data; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * wr_byte - write a byte, one bit at a time | 
					
						
							|  |  |  |  * @dd: the qlogic_ib device | 
					
						
							|  |  |  |  * @data: the byte to write | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Returns 0 if we got the following ack, otherwise 1 | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int wr_byte(struct qib_devdata *dd, u8 data) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int bit_cntr; | 
					
						
							|  |  |  | 	u8 bit; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	for (bit_cntr = 7; bit_cntr >= 0; bit_cntr--) { | 
					
						
							|  |  |  | 		bit = (data >> bit_cntr) & 1; | 
					
						
							|  |  |  | 		sda_out(dd, bit); | 
					
						
							|  |  |  | 		scl_out(dd, 1); | 
					
						
							|  |  |  | 		scl_out(dd, 0); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	return (!i2c_ackrcv(dd)) ? 1 : 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * issue TWSI start sequence: | 
					
						
							|  |  |  |  * (both clock/data high, clock high, data low while clock is high) | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void start_seq(struct qib_devdata *dd) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	sda_out(dd, 1); | 
					
						
							|  |  |  | 	scl_out(dd, 1); | 
					
						
							|  |  |  | 	sda_out(dd, 0); | 
					
						
							|  |  |  | 	udelay(1); | 
					
						
							|  |  |  | 	scl_out(dd, 0); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * stop_seq - transmit the stop sequence | 
					
						
							|  |  |  |  * @dd: the qlogic_ib device | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * (both clock/data low, clock high, data high while clock is high) | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void stop_seq(struct qib_devdata *dd) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	scl_out(dd, 0); | 
					
						
							|  |  |  | 	sda_out(dd, 0); | 
					
						
							|  |  |  | 	scl_out(dd, 1); | 
					
						
							|  |  |  | 	sda_out(dd, 1); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * stop_cmd - transmit the stop condition | 
					
						
							|  |  |  |  * @dd: the qlogic_ib device | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * (both clock/data low, clock high, data high while clock is high) | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void stop_cmd(struct qib_devdata *dd) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	stop_seq(dd); | 
					
						
							|  |  |  | 	udelay(TWSI_BUF_WAIT_USEC); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * qib_twsi_reset - reset I2C communication | 
					
						
							|  |  |  |  * @dd: the qlogic_ib device | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | int qib_twsi_reset(struct qib_devdata *dd) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int clock_cycles_left = 9; | 
					
						
							|  |  |  | 	int was_high = 0; | 
					
						
							|  |  |  | 	u32 pins, mask; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Both SCL and SDA should be high. If not, there
 | 
					
						
							|  |  |  | 	 * is something wrong. | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	mask = (1UL << dd->gpio_scl_num) | (1UL << dd->gpio_sda_num); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * Force pins to desired innocuous state. | 
					
						
							|  |  |  | 	 * This is the default power-on state with out=0 and dir=0, | 
					
						
							|  |  |  | 	 * So tri-stated and should be floating high (barring HW problems) | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	dd->f_gpio_mod(dd, 0, 0, mask); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * Clock nine times to get all listeners into a sane state. | 
					
						
							|  |  |  | 	 * If SDA does not go high at any point, we are wedged. | 
					
						
							|  |  |  | 	 * One vendor recommends then issuing START followed by STOP. | 
					
						
							|  |  |  | 	 * we cannot use our "normal" functions to do that, because | 
					
						
							|  |  |  | 	 * if SCL drops between them, another vendor's part will | 
					
						
							|  |  |  | 	 * wedge, dropping SDA and keeping it low forever, at the end of | 
					
						
							|  |  |  | 	 * the next transaction (even if it was not the device addressed). | 
					
						
							|  |  |  | 	 * So our START and STOP take place with SCL held high. | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	while (clock_cycles_left--) { | 
					
						
							|  |  |  | 		scl_out(dd, 0); | 
					
						
							|  |  |  | 		scl_out(dd, 1); | 
					
						
							|  |  |  | 		/* Note if SDA is high, but keep clocking to sync slave */ | 
					
						
							|  |  |  | 		was_high |= sda_in(dd, 0); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (was_high) { | 
					
						
							|  |  |  | 		/*
 | 
					
						
							|  |  |  | 		 * We saw a high, which we hope means the slave is sync'd. | 
					
						
							|  |  |  | 		 * Issue START, STOP, pause for T_BUF. | 
					
						
							|  |  |  | 		 */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		pins = dd->f_gpio_mod(dd, 0, 0, 0); | 
					
						
							|  |  |  | 		if ((pins & mask) != mask) | 
					
						
							|  |  |  | 			qib_dev_err(dd, "GPIO pins not at rest: %d\n", | 
					
						
							|  |  |  | 				    pins & mask); | 
					
						
							|  |  |  | 		/* Drop SDA to issue START */ | 
					
						
							|  |  |  | 		udelay(1); /* Guarantee .6 uSec setup */ | 
					
						
							|  |  |  | 		sda_out(dd, 0); | 
					
						
							|  |  |  | 		udelay(1); /* Guarantee .6 uSec hold */ | 
					
						
							|  |  |  | 		/* At this point, SCL is high, SDA low. Raise SDA for STOP */ | 
					
						
							|  |  |  | 		sda_out(dd, 1); | 
					
						
							|  |  |  | 		udelay(TWSI_BUF_WAIT_USEC); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return !was_high; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define QIB_TWSI_START 0x100
 | 
					
						
							|  |  |  | #define QIB_TWSI_STOP 0x200
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* Write byte to TWSI, optionally prefixed with START or suffixed with
 | 
					
						
							|  |  |  |  * STOP. | 
					
						
							|  |  |  |  * returns 0 if OK (ACK received), else != 0 | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int qib_twsi_wr(struct qib_devdata *dd, int data, int flags) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int ret = 1; | 
					
						
							|  |  |  | 	if (flags & QIB_TWSI_START) | 
					
						
							|  |  |  | 		start_seq(dd); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	ret = wr_byte(dd, data); /* Leaves SCL low (from i2c_ackrcv()) */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (flags & QIB_TWSI_STOP) | 
					
						
							|  |  |  | 		stop_cmd(dd); | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* Added functionality for IBA7220-based cards */ | 
					
						
							|  |  |  | #define QIB_TEMP_DEV 0x98
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * qib_twsi_blk_rd | 
					
						
							|  |  |  |  * Formerly called qib_eeprom_internal_read, and only used for eeprom, | 
					
						
							|  |  |  |  * but now the general interface for data transfer from twsi devices. | 
					
						
							|  |  |  |  * One vestige of its former role is that it recognizes a device | 
					
						
							|  |  |  |  * QIB_TWSI_NO_DEV and does the correct operation for the legacy part, | 
					
						
							|  |  |  |  * which responded to all TWSI device codes, interpreting them as | 
					
						
							|  |  |  |  * address within device. On all other devices found on board handled by | 
					
						
							|  |  |  |  * this driver, the device is followed by a one-byte "address" which selects | 
					
						
							|  |  |  |  * the "register" or "offset" within the device from which data should | 
					
						
							|  |  |  |  * be read. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | int qib_twsi_blk_rd(struct qib_devdata *dd, int dev, int addr, | 
					
						
							|  |  |  | 		    void *buffer, int len) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int ret; | 
					
						
							|  |  |  | 	u8 *bp = buffer; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	ret = 1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (dev == QIB_TWSI_NO_DEV) { | 
					
						
							|  |  |  | 		/* legacy not-really-I2C */ | 
					
						
							|  |  |  | 		addr = (addr << 1) | READ_CMD; | 
					
						
							|  |  |  | 		ret = qib_twsi_wr(dd, addr, QIB_TWSI_START); | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		/* Actual I2C */ | 
					
						
							|  |  |  | 		ret = qib_twsi_wr(dd, dev | WRITE_CMD, QIB_TWSI_START); | 
					
						
							|  |  |  | 		if (ret) { | 
					
						
							|  |  |  | 			stop_cmd(dd); | 
					
						
							|  |  |  | 			ret = 1; | 
					
						
							|  |  |  | 			goto bail; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		/*
 | 
					
						
							|  |  |  | 		 * SFF spec claims we do _not_ stop after the addr | 
					
						
							|  |  |  | 		 * but simply issue a start with the "read" dev-addr. | 
					
						
							|  |  |  | 		 * Since we are implicitely waiting for ACK here, | 
					
						
							|  |  |  | 		 * we need t_buf (nominally 20uSec) before that start, | 
					
						
							|  |  |  | 		 * and cannot rely on the delay built in to the STOP | 
					
						
							|  |  |  | 		 */ | 
					
						
							|  |  |  | 		ret = qib_twsi_wr(dd, addr, 0); | 
					
						
							|  |  |  | 		udelay(TWSI_BUF_WAIT_USEC); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (ret) { | 
					
						
							|  |  |  | 			qib_dev_err(dd, | 
					
						
							|  |  |  | 				"Failed to write interface read addr %02X\n", | 
					
						
							|  |  |  | 				addr); | 
					
						
							|  |  |  | 			ret = 1; | 
					
						
							|  |  |  | 			goto bail; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		ret = qib_twsi_wr(dd, dev | READ_CMD, QIB_TWSI_START); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		stop_cmd(dd); | 
					
						
							|  |  |  | 		ret = 1; | 
					
						
							|  |  |  | 		goto bail; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * block devices keeps clocking data out as long as we ack, | 
					
						
							|  |  |  | 	 * automatically incrementing the address. Some have "pages" | 
					
						
							|  |  |  | 	 * whose boundaries will not be crossed, but the handling | 
					
						
							|  |  |  | 	 * of these is left to the caller, who is in a better | 
					
						
							|  |  |  | 	 * position to know. | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	while (len-- > 0) { | 
					
						
							|  |  |  | 		/*
 | 
					
						
							|  |  |  | 		 * Get and store data, sending ACK if length remaining, | 
					
						
							|  |  |  | 		 * else STOP | 
					
						
							|  |  |  | 		 */ | 
					
						
							|  |  |  | 		*bp++ = rd_byte(dd, !len); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	ret = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | bail: | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * qib_twsi_blk_wr | 
					
						
							|  |  |  |  * Formerly called qib_eeprom_internal_write, and only used for eeprom, | 
					
						
							|  |  |  |  * but now the general interface for data transfer to twsi devices. | 
					
						
							|  |  |  |  * One vestige of its former role is that it recognizes a device | 
					
						
							|  |  |  |  * QIB_TWSI_NO_DEV and does the correct operation for the legacy part, | 
					
						
							|  |  |  |  * which responded to all TWSI device codes, interpreting them as | 
					
						
							|  |  |  |  * address within device. On all other devices found on board handled by | 
					
						
							|  |  |  |  * this driver, the device is followed by a one-byte "address" which selects | 
					
						
							|  |  |  |  * the "register" or "offset" within the device to which data should | 
					
						
							|  |  |  |  * be written. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | int qib_twsi_blk_wr(struct qib_devdata *dd, int dev, int addr, | 
					
						
							|  |  |  | 		    const void *buffer, int len) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int sub_len; | 
					
						
							|  |  |  | 	const u8 *bp = buffer; | 
					
						
							|  |  |  | 	int max_wait_time, i; | 
					
						
							|  |  |  | 	int ret; | 
					
						
							|  |  |  | 	ret = 1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	while (len > 0) { | 
					
						
							|  |  |  | 		if (dev == QIB_TWSI_NO_DEV) { | 
					
						
							|  |  |  | 			if (qib_twsi_wr(dd, (addr << 1) | WRITE_CMD, | 
					
						
							|  |  |  | 					QIB_TWSI_START)) { | 
					
						
							|  |  |  | 				goto failed_write; | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 		} else { | 
					
						
							|  |  |  | 			/* Real I2C */ | 
					
						
							|  |  |  | 			if (qib_twsi_wr(dd, dev | WRITE_CMD, QIB_TWSI_START)) | 
					
						
							|  |  |  | 				goto failed_write; | 
					
						
							|  |  |  | 			ret = qib_twsi_wr(dd, addr, 0); | 
					
						
							|  |  |  | 			if (ret) { | 
					
						
							| 
									
										
										
										
											2012-07-19 13:04:25 +00:00
										 |  |  | 				qib_dev_err(dd, | 
					
						
							|  |  |  | 					"Failed to write interface write addr %02X\n", | 
					
						
							|  |  |  | 					addr); | 
					
						
							| 
									
										
										
										
											2010-05-23 21:44:54 -07:00
										 |  |  | 				goto failed_write; | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		sub_len = min(len, 4); | 
					
						
							|  |  |  | 		addr += sub_len; | 
					
						
							|  |  |  | 		len -= sub_len; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		for (i = 0; i < sub_len; i++) | 
					
						
							|  |  |  | 			if (qib_twsi_wr(dd, *bp++, 0)) | 
					
						
							|  |  |  | 				goto failed_write; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		stop_cmd(dd); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		/*
 | 
					
						
							|  |  |  | 		 * Wait for write complete by waiting for a successful | 
					
						
							|  |  |  | 		 * read (the chip replies with a zero after the write | 
					
						
							|  |  |  | 		 * cmd completes, and before it writes to the eeprom. | 
					
						
							|  |  |  | 		 * The startcmd for the read will fail the ack until | 
					
						
							|  |  |  | 		 * the writes have completed.   We do this inline to avoid | 
					
						
							|  |  |  | 		 * the debug prints that are in the real read routine | 
					
						
							|  |  |  | 		 * if the startcmd fails. | 
					
						
							|  |  |  | 		 * We also use the proper device address, so it doesn't matter | 
					
						
							|  |  |  | 		 * whether we have real eeprom_dev. Legacy likes any address. | 
					
						
							|  |  |  | 		 */ | 
					
						
							|  |  |  | 		max_wait_time = 100; | 
					
						
							|  |  |  | 		while (qib_twsi_wr(dd, dev | READ_CMD, QIB_TWSI_START)) { | 
					
						
							|  |  |  | 			stop_cmd(dd); | 
					
						
							|  |  |  | 			if (!--max_wait_time) | 
					
						
							|  |  |  | 				goto failed_write; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		/* now read (and ignore) the resulting byte */ | 
					
						
							|  |  |  | 		rd_byte(dd, 1); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	ret = 0; | 
					
						
							|  |  |  | 	goto bail; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | failed_write: | 
					
						
							|  |  |  | 	stop_cmd(dd); | 
					
						
							|  |  |  | 	ret = 1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | bail: | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } |