| /* |
| * Copyright (c) 2006, 2007 QLogic Corporation. All rights reserved. |
| * 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 "ipath_kernel.h" |
| |
| /* |
| * InfiniPath I2C driver for a serial eeprom. This is not a generic |
| * I2C interface. For a start, the device we're using (Atmel AT24C11) |
| * doesn't work like a regular I2C device. It looks like one |
| * electrically, but not logically. Normal I2C devices have a single |
| * 7-bit or 10-bit I2C address that they respond to. Valid 7-bit |
| * addresses range from 0x03 to 0x77. Addresses 0x00 to 0x02 and 0x78 |
| * to 0x7F are special reserved addresses (e.g. 0x00 is the "general |
| * call" address.) The Atmel device, on the other hand, responds to ALL |
| * 7-bit addresses. It's designed to be the only device on a given I2C |
| * bus. A 7-bit address corresponds to the memory address within the |
| * Atmel device itself. |
| * |
| * Also, the timing requirements mean more than simple software |
| * bitbanging, with readbacks from chip to ensure timing (simple udelay |
| * is not enough). |
| * |
| * This all means that accessing the device is specialized enough |
| * that using the standard kernel I2C bitbanging interface would be |
| * impossible. For example, the core I2C eeprom driver expects to find |
| * a device at one or more of a limited set of addresses only. It doesn't |
| * allow writing to an eeprom. It also doesn't provide any means of |
| * accessing eeprom contents from within the kernel, only via sysfs. |
| */ |
| |
| enum i2c_type { |
| i2c_line_scl = 0, |
| i2c_line_sda |
| }; |
| |
| enum i2c_state { |
| i2c_line_low = 0, |
| i2c_line_high |
| }; |
| |
| #define READ_CMD 1 |
| #define WRITE_CMD 0 |
| |
| static int eeprom_init; |
| |
| /* |
| * The gpioval manipulation really should be protected by spinlocks |
| * or be converted to use atomic operations. |
| */ |
| |
| /** |
| * i2c_gpio_set - set a GPIO line |
| * @dd: the infinipath device |
| * @line: the line to set |
| * @new_line_state: the state to set |
| * |
| * Returns 0 if the line was set to the new state successfully, non-zero |
| * on error. |
| */ |
| static int i2c_gpio_set(struct ipath_devdata *dd, |
| enum i2c_type line, |
| enum i2c_state new_line_state) |
| { |
| u64 out_mask, dir_mask, *gpioval; |
| unsigned long flags = 0; |
| |
| gpioval = &dd->ipath_gpio_out; |
| |
| if (line == i2c_line_scl) { |
| dir_mask = dd->ipath_gpio_scl; |
| out_mask = (1UL << dd->ipath_gpio_scl_num); |
| } else { |
| dir_mask = dd->ipath_gpio_sda; |
| out_mask = (1UL << dd->ipath_gpio_sda_num); |
| } |
| |
| spin_lock_irqsave(&dd->ipath_gpio_lock, flags); |
| if (new_line_state == i2c_line_high) { |
| /* tri-state the output rather than force high */ |
| dd->ipath_extctrl &= ~dir_mask; |
| } else { |
| /* config line to be an output */ |
| dd->ipath_extctrl |= dir_mask; |
| } |
| ipath_write_kreg(dd, dd->ipath_kregs->kr_extctrl, dd->ipath_extctrl); |
| |
| /* set output as well (no real verify) */ |
| if (new_line_state == i2c_line_high) |
| *gpioval |= out_mask; |
| else |
| *gpioval &= ~out_mask; |
| |
| ipath_write_kreg(dd, dd->ipath_kregs->kr_gpio_out, *gpioval); |
| spin_unlock_irqrestore(&dd->ipath_gpio_lock, flags); |
| |
| return 0; |
| } |
| |
| /** |
| * i2c_gpio_get - get a GPIO line state |
| * @dd: the infinipath device |
| * @line: the line to get |
| * @curr_statep: where to put the line state |
| * |
| * Returns 0 if the line was set to the new state successfully, non-zero |
| * on error. curr_state is not set on error. |
| */ |
| static int i2c_gpio_get(struct ipath_devdata *dd, |
| enum i2c_type line, |
| enum i2c_state *curr_statep) |
| { |
| u64 read_val, mask; |
| int ret; |
| unsigned long flags = 0; |
| |
| /* check args */ |
| if (curr_statep == NULL) { |
| ret = 1; |
| goto bail; |
| } |
| |
| /* config line to be an input */ |
| if (line == i2c_line_scl) |
| mask = dd->ipath_gpio_scl; |
| else |
| mask = dd->ipath_gpio_sda; |
| |
| spin_lock_irqsave(&dd->ipath_gpio_lock, flags); |
| dd->ipath_extctrl &= ~mask; |
| ipath_write_kreg(dd, dd->ipath_kregs->kr_extctrl, dd->ipath_extctrl); |
| /* |
| * Below is very unlikely to reflect true input state if Output |
| * Enable actually changed. |
| */ |
| read_val = ipath_read_kreg64(dd, dd->ipath_kregs->kr_extstatus); |
| spin_unlock_irqrestore(&dd->ipath_gpio_lock, flags); |
| |
| if (read_val & mask) |
| *curr_statep = i2c_line_high; |
| else |
| *curr_statep = i2c_line_low; |
| |
| ret = 0; |
| |
| bail: |
| return ret; |
| } |
| |
| /** |
| * i2c_wait_for_writes - wait for a write |
| * @dd: the infinipath 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 ipath_devdata *dd) |
| { |
| (void)ipath_read_kreg32(dd, dd->ipath_kregs->kr_scratch); |
| rmb(); |
| } |
| |
| static void scl_out(struct ipath_devdata *dd, u8 bit) |
| { |
| udelay(1); |
| i2c_gpio_set(dd, i2c_line_scl, bit ? i2c_line_high : i2c_line_low); |
| |
| i2c_wait_for_writes(dd); |
| } |
| |
| static void sda_out(struct ipath_devdata *dd, u8 bit) |
| { |
| i2c_gpio_set(dd, i2c_line_sda, bit ? i2c_line_high : i2c_line_low); |
| |
| i2c_wait_for_writes(dd); |
| } |
| |
| static u8 sda_in(struct ipath_devdata *dd, int wait) |
| { |
| enum i2c_state bit; |
| |
| if (i2c_gpio_get(dd, i2c_line_sda, &bit)) |
| ipath_dbg("get bit failed!\n"); |
| |
| if (wait) |
| i2c_wait_for_writes(dd); |
| |
| return bit == i2c_line_high ? 1U : 0; |
| } |
| |
| /** |
| * i2c_ackrcv - see if ack following write is true |
| * @dd: the infinipath device |
| */ |
| static int i2c_ackrcv(struct ipath_devdata *dd) |
| { |
| u8 ack_received; |
| |
| /* AT ENTRY SCL = LOW */ |
| /* change direction, ignore data */ |
| ack_received = sda_in(dd, 1); |
| scl_out(dd, i2c_line_high); |
| ack_received = sda_in(dd, 1) == 0; |
| scl_out(dd, i2c_line_low); |
| return ack_received; |
| } |
| |
| /** |
| * wr_byte - write a byte, one bit at a time |
| * @dd: the infinipath device |
| * @data: the byte to write |
| * |
| * Returns 0 if we got the following ack, otherwise 1 |
| */ |
| static int wr_byte(struct ipath_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, i2c_line_high); |
| scl_out(dd, i2c_line_low); |
| } |
| return (!i2c_ackrcv(dd)) ? 1 : 0; |
| } |
| |
| static void send_ack(struct ipath_devdata *dd) |
| { |
| sda_out(dd, i2c_line_low); |
| scl_out(dd, i2c_line_high); |
| scl_out(dd, i2c_line_low); |
| sda_out(dd, i2c_line_high); |
| } |
| |
| /** |
| * i2c_startcmd - transmit the start condition, followed by address/cmd |
| * @dd: the infinipath device |
| * @offset_dir: direction byte |
| * |
| * (both clock/data high, clock high, data low while clock is high) |
| */ |
| static int i2c_startcmd(struct ipath_devdata *dd, u8 offset_dir) |
| { |
| int res; |
| |
| /* issue start sequence */ |
| sda_out(dd, i2c_line_high); |
| scl_out(dd, i2c_line_high); |
| sda_out(dd, i2c_line_low); |
| scl_out(dd, i2c_line_low); |
| |
| /* issue length and direction byte */ |
| res = wr_byte(dd, offset_dir); |
| |
| if (res) |
| ipath_cdbg(VERBOSE, "No ack to complete start\n"); |
| |
| return res; |
| } |
| |
| /** |
| * stop_cmd - transmit the stop condition |
| * @dd: the infinipath device |
| * |
| * (both clock/data low, clock high, data high while clock is high) |
| */ |
| static void stop_cmd(struct ipath_devdata *dd) |
| { |
| scl_out(dd, i2c_line_low); |
| sda_out(dd, i2c_line_low); |
| scl_out(dd, i2c_line_high); |
| sda_out(dd, i2c_line_high); |
| udelay(2); |
| } |
| |
| /** |
| * eeprom_reset - reset I2C communication |
| * @dd: the infinipath device |
| */ |
| |
| static int eeprom_reset(struct ipath_devdata *dd) |
| { |
| int clock_cycles_left = 9; |
| u64 *gpioval = &dd->ipath_gpio_out; |
| int ret; |
| unsigned long flags; |
| |
| spin_lock_irqsave(&dd->ipath_gpio_lock, flags); |
| /* Make sure shadows are consistent */ |
| dd->ipath_extctrl = ipath_read_kreg64(dd, dd->ipath_kregs->kr_extctrl); |
| *gpioval = ipath_read_kreg64(dd, dd->ipath_kregs->kr_gpio_out); |
| spin_unlock_irqrestore(&dd->ipath_gpio_lock, flags); |
| |
| ipath_cdbg(VERBOSE, "Resetting i2c eeprom; initial gpioout reg " |
| "is %llx\n", (unsigned long long) *gpioval); |
| |
| eeprom_init = 1; |
| /* |
| * This is to get the i2c into a known state, by first going low, |
| * then tristate sda (and then tristate scl as first thing |
| * in loop) |
| */ |
| scl_out(dd, i2c_line_low); |
| sda_out(dd, i2c_line_high); |
| |
| while (clock_cycles_left--) { |
| scl_out(dd, i2c_line_high); |
| |
| if (sda_in(dd, 0)) { |
| sda_out(dd, i2c_line_low); |
| scl_out(dd, i2c_line_low); |
| ret = 0; |
| goto bail; |
| } |
| |
| scl_out(dd, i2c_line_low); |
| } |
| |
| ret = 1; |
| |
| bail: |
| return ret; |
| } |
| |
| /** |
| * ipath_eeprom_read - receives bytes from the eeprom via I2C |
| * @dd: the infinipath device |
| * @eeprom_offset: address to read from |
| * @buffer: where to store result |
| * @len: number of bytes to receive |
| */ |
| |
| static int ipath_eeprom_internal_read(struct ipath_devdata *dd, |
| u8 eeprom_offset, void *buffer, int len) |
| { |
| /* compiler complains unless initialized */ |
| u8 single_byte = 0; |
| int bit_cntr; |
| int ret; |
| |
| if (!eeprom_init) |
| eeprom_reset(dd); |
| |
| eeprom_offset = (eeprom_offset << 1) | READ_CMD; |
| |
| if (i2c_startcmd(dd, eeprom_offset)) { |
| ipath_dbg("Failed startcmd\n"); |
| stop_cmd(dd); |
| ret = 1; |
| goto bail; |
| } |
| |
| /* |
| * eeprom keeps clocking data out as long as we ack, automatically |
| * incrementing the address. |
| */ |
| while (len-- > 0) { |
| /* get data */ |
| single_byte = 0; |
| for (bit_cntr = 8; bit_cntr; bit_cntr--) { |
| u8 bit; |
| scl_out(dd, i2c_line_high); |
| bit = sda_in(dd, 0); |
| single_byte |= bit << (bit_cntr - 1); |
| scl_out(dd, i2c_line_low); |
| } |
| |
| /* send ack if not the last byte */ |
| if (len) |
| send_ack(dd); |
| |
| *((u8 *) buffer) = single_byte; |
| buffer++; |
| } |
| |
| stop_cmd(dd); |
| |
| ret = 0; |
| |
| bail: |
| return ret; |
| } |
| |
| |
| /** |
| * ipath_eeprom_write - writes data to the eeprom via I2C |
| * @dd: the infinipath device |
| * @eeprom_offset: where to place data |
| * @buffer: data to write |
| * @len: number of bytes to write |
| */ |
| static int ipath_eeprom_internal_write(struct ipath_devdata *dd, u8 eeprom_offset, |
| const void *buffer, int len) |
| { |
| u8 single_byte; |
| int sub_len; |
| const u8 *bp = buffer; |
| int max_wait_time, i; |
| int ret; |
| |
| if (!eeprom_init) |
| eeprom_reset(dd); |
| |
| while (len > 0) { |
| if (i2c_startcmd(dd, (eeprom_offset << 1) | WRITE_CMD)) { |
| ipath_dbg("Failed to start cmd offset %u\n", |
| eeprom_offset); |
| goto failed_write; |
| } |
| |
| sub_len = min(len, 4); |
| eeprom_offset += sub_len; |
| len -= sub_len; |
| |
| for (i = 0; i < sub_len; i++) { |
| if (wr_byte(dd, *bp++)) { |
| ipath_dbg("no ack after byte %u/%u (%u " |
| "total remain)\n", i, sub_len, |
| len + sub_len - i); |
| 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. |
| */ |
| max_wait_time = 100; |
| while (i2c_startcmd(dd, READ_CMD)) { |
| stop_cmd(dd); |
| if (!--max_wait_time) { |
| ipath_dbg("Did not get successful read to " |
| "complete write\n"); |
| goto failed_write; |
| } |
| } |
| /* now read the zero byte */ |
| for (i = single_byte = 0; i < 8; i++) { |
| u8 bit; |
| scl_out(dd, i2c_line_high); |
| bit = sda_in(dd, 0); |
| scl_out(dd, i2c_line_low); |
| single_byte <<= 1; |
| single_byte |= bit; |
| } |
| stop_cmd(dd); |
| } |
| |
| ret = 0; |
| goto bail; |
| |
| failed_write: |
| stop_cmd(dd); |
| ret = 1; |
| |
| bail: |
| return ret; |
| } |
| |
| /* |
| * The public entry-points ipath_eeprom_read() and ipath_eeprom_write() |
| * are now just wrappers around the internal functions. |
| */ |
| int ipath_eeprom_read(struct ipath_devdata *dd, u8 eeprom_offset, |
| void *buff, int len) |
| { |
| int ret; |
| |
| ret = down_interruptible(&dd->ipath_eep_sem); |
| if (!ret) { |
| ret = ipath_eeprom_internal_read(dd, eeprom_offset, buff, len); |
| up(&dd->ipath_eep_sem); |
| } |
| |
| return ret; |
| } |
| |
| int ipath_eeprom_write(struct ipath_devdata *dd, u8 eeprom_offset, |
| const void *buff, int len) |
| { |
| int ret; |
| |
| ret = down_interruptible(&dd->ipath_eep_sem); |
| if (!ret) { |
| ret = ipath_eeprom_internal_write(dd, eeprom_offset, buff, len); |
| up(&dd->ipath_eep_sem); |
| } |
| |
| return ret; |
| } |
| |
| static u8 flash_csum(struct ipath_flash *ifp, int adjust) |
| { |
| u8 *ip = (u8 *) ifp; |
| u8 csum = 0, len; |
| |
| for (len = 0; len < ifp->if_length; len++) |
| csum += *ip++; |
| csum -= ifp->if_csum; |
| csum = ~csum; |
| if (adjust) |
| ifp->if_csum = csum; |
| |
| return csum; |
| } |
| |
| /** |
| * ipath_get_guid - get the GUID from the i2c device |
| * @dd: the infinipath device |
| * |
| * We have the capability to use the ipath_nguid field, and get |
| * the guid from the first chip's flash, to use for all of them. |
| */ |
| void ipath_get_eeprom_info(struct ipath_devdata *dd) |
| { |
| void *buf; |
| struct ipath_flash *ifp; |
| __be64 guid; |
| int len, eep_stat; |
| u8 csum, *bguid; |
| int t = dd->ipath_unit; |
| struct ipath_devdata *dd0 = ipath_lookup(0); |
| |
| if (t && dd0->ipath_nguid > 1 && t <= dd0->ipath_nguid) { |
| u8 *bguid, oguid; |
| dd->ipath_guid = dd0->ipath_guid; |
| bguid = (u8 *) & dd->ipath_guid; |
| |
| oguid = bguid[7]; |
| bguid[7] += t; |
| if (oguid > bguid[7]) { |
| if (bguid[6] == 0xff) { |
| if (bguid[5] == 0xff) { |
| ipath_dev_err( |
| dd, |
| "Can't set %s GUID from " |
| "base, wraps to OUI!\n", |
| ipath_get_unit_name(t)); |
| dd->ipath_guid = 0; |
| goto bail; |
| } |
| bguid[5]++; |
| } |
| bguid[6]++; |
| } |
| dd->ipath_nguid = 1; |
| |
| ipath_dbg("nguid %u, so adding %u to device 0 guid, " |
| "for %llx\n", |
| dd0->ipath_nguid, t, |
| (unsigned long long) be64_to_cpu(dd->ipath_guid)); |
| goto bail; |
| } |
| |
| /* |
| * read full flash, not just currently used part, since it may have |
| * been written with a newer definition |
| * */ |
| len = sizeof(struct ipath_flash); |
| buf = vmalloc(len); |
| if (!buf) { |
| ipath_dev_err(dd, "Couldn't allocate memory to read %u " |
| "bytes from eeprom for GUID\n", len); |
| goto bail; |
| } |
| |
| down(&dd->ipath_eep_sem); |
| eep_stat = ipath_eeprom_internal_read(dd, 0, buf, len); |
| up(&dd->ipath_eep_sem); |
| |
| if (eep_stat) { |
| ipath_dev_err(dd, "Failed reading GUID from eeprom\n"); |
| goto done; |
| } |
| ifp = (struct ipath_flash *)buf; |
| |
| csum = flash_csum(ifp, 0); |
| if (csum != ifp->if_csum) { |
| dev_info(&dd->pcidev->dev, "Bad I2C flash checksum: " |
| "0x%x, not 0x%x\n", csum, ifp->if_csum); |
| goto done; |
| } |
| if (*(__be64 *) ifp->if_guid == 0ULL || |
| *(__be64 *) ifp->if_guid == __constant_cpu_to_be64(-1LL)) { |
| ipath_dev_err(dd, "Invalid GUID %llx from flash; " |
| "ignoring\n", |
| *(unsigned long long *) ifp->if_guid); |
| /* don't allow GUID if all 0 or all 1's */ |
| goto done; |
| } |
| |
| /* complain, but allow it */ |
| if (*(u64 *) ifp->if_guid == 0x100007511000000ULL) |
| dev_info(&dd->pcidev->dev, "Warning, GUID %llx is " |
| "default, probably not correct!\n", |
| *(unsigned long long *) ifp->if_guid); |
| |
| bguid = ifp->if_guid; |
| if (!bguid[0] && !bguid[1] && !bguid[2]) { |
| /* original incorrect GUID format in flash; fix in |
| * core copy, by shifting up 2 octets; don't need to |
| * change top octet, since both it and shifted are |
| * 0.. */ |
| bguid[1] = bguid[3]; |
| bguid[2] = bguid[4]; |
| bguid[3] = bguid[4] = 0; |
| guid = *(__be64 *) ifp->if_guid; |
| ipath_cdbg(VERBOSE, "Old GUID format in flash, top 3 zero, " |
| "shifting 2 octets\n"); |
| } else |
| guid = *(__be64 *) ifp->if_guid; |
| dd->ipath_guid = guid; |
| dd->ipath_nguid = ifp->if_numguid; |
| /* |
| * Things are slightly complicated by the desire to transparently |
| * support both the Pathscale 10-digit serial number and the QLogic |
| * 13-character version. |
| */ |
| if ((ifp->if_fversion > 1) && ifp->if_sprefix[0] |
| && ((u8 *)ifp->if_sprefix)[0] != 0xFF) { |
| /* This board has a Serial-prefix, which is stored |
| * elsewhere for backward-compatibility. |
| */ |
| char *snp = dd->ipath_serial; |
| int len; |
| memcpy(snp, ifp->if_sprefix, sizeof ifp->if_sprefix); |
| snp[sizeof ifp->if_sprefix] = '\0'; |
| len = strlen(snp); |
| snp += len; |
| len = (sizeof dd->ipath_serial) - len; |
| if (len > sizeof ifp->if_serial) { |
| len = sizeof ifp->if_serial; |
| } |
| memcpy(snp, ifp->if_serial, len); |
| } else |
| memcpy(dd->ipath_serial, ifp->if_serial, |
| sizeof ifp->if_serial); |
| if (!strstr(ifp->if_comment, "Tested successfully")) |
| ipath_dev_err(dd, "Board SN %s did not pass functional " |
| "test: %s\n", dd->ipath_serial, |
| ifp->if_comment); |
| |
| ipath_cdbg(VERBOSE, "Initted GUID to %llx from eeprom\n", |
| (unsigned long long) be64_to_cpu(dd->ipath_guid)); |
| |
| memcpy(&dd->ipath_eep_st_errs, &ifp->if_errcntp, IPATH_EEP_LOG_CNT); |
| /* |
| * Power-on (actually "active") hours are kept as little-endian value |
| * in EEPROM, but as seconds in a (possibly as small as 24-bit) |
| * atomic_t while running. |
| */ |
| atomic_set(&dd->ipath_active_time, 0); |
| dd->ipath_eep_hrs = ifp->if_powerhour[0] | (ifp->if_powerhour[1] << 8); |
| |
| done: |
| vfree(buf); |
| |
| bail:; |
| } |
| |
| /** |
| * ipath_update_eeprom_log - copy active-time and error counters to eeprom |
| * @dd: the infinipath device |
| * |
| * Although the time is kept as seconds in the ipath_devdata struct, it is |
| * rounded to hours for re-write, as we have only 16 bits in EEPROM. |
| * First-cut code reads whole (expected) struct ipath_flash, modifies, |
| * re-writes. Future direction: read/write only what we need, assuming |
| * that the EEPROM had to have been "good enough" for driver init, and |
| * if not, we aren't making it worse. |
| * |
| */ |
| |
| int ipath_update_eeprom_log(struct ipath_devdata *dd) |
| { |
| void *buf; |
| struct ipath_flash *ifp; |
| int len, hi_water; |
| uint32_t new_time, new_hrs; |
| u8 csum; |
| int ret, idx; |
| unsigned long flags; |
| |
| /* first, check if we actually need to do anything. */ |
| ret = 0; |
| for (idx = 0; idx < IPATH_EEP_LOG_CNT; ++idx) { |
| if (dd->ipath_eep_st_new_errs[idx]) { |
| ret = 1; |
| break; |
| } |
| } |
| new_time = atomic_read(&dd->ipath_active_time); |
| |
| if (ret == 0 && new_time < 3600) |
| return 0; |
| |
| /* |
| * The quick-check above determined that there is something worthy |
| * of logging, so get current contents and do a more detailed idea. |
| * read full flash, not just currently used part, since it may have |
| * been written with a newer definition |
| */ |
| len = sizeof(struct ipath_flash); |
| buf = vmalloc(len); |
| ret = 1; |
| if (!buf) { |
| ipath_dev_err(dd, "Couldn't allocate memory to read %u " |
| "bytes from eeprom for logging\n", len); |
| goto bail; |
| } |
| |
| /* Grab semaphore and read current EEPROM. If we get an |
| * error, let go, but if not, keep it until we finish write. |
| */ |
| ret = down_interruptible(&dd->ipath_eep_sem); |
| if (ret) { |
| ipath_dev_err(dd, "Unable to acquire EEPROM for logging\n"); |
| goto free_bail; |
| } |
| ret = ipath_eeprom_internal_read(dd, 0, buf, len); |
| if (ret) { |
| up(&dd->ipath_eep_sem); |
| ipath_dev_err(dd, "Unable read EEPROM for logging\n"); |
| goto free_bail; |
| } |
| ifp = (struct ipath_flash *)buf; |
| |
| csum = flash_csum(ifp, 0); |
| if (csum != ifp->if_csum) { |
| up(&dd->ipath_eep_sem); |
| ipath_dev_err(dd, "EEPROM cks err (0x%02X, S/B 0x%02X)\n", |
| csum, ifp->if_csum); |
| ret = 1; |
| goto free_bail; |
| } |
| hi_water = 0; |
| spin_lock_irqsave(&dd->ipath_eep_st_lock, flags); |
| for (idx = 0; idx < IPATH_EEP_LOG_CNT; ++idx) { |
| int new_val = dd->ipath_eep_st_new_errs[idx]; |
| if (new_val) { |
| /* |
| * If we have seen any errors, add to EEPROM values |
| * We need to saturate at 0xFF (255) and we also |
| * would need to adjust the checksum if we were |
| * trying to minimize EEPROM traffic |
| * Note that we add to actual current count in EEPROM, |
| * in case it was altered while we were running. |
| */ |
| new_val += ifp->if_errcntp[idx]; |
| if (new_val > 0xFF) |
| new_val = 0xFF; |
| if (ifp->if_errcntp[idx] != new_val) { |
| ifp->if_errcntp[idx] = new_val; |
| hi_water = offsetof(struct ipath_flash, |
| if_errcntp) + idx; |
| } |
| /* |
| * update our shadow (used to minimize EEPROM |
| * traffic), to match what we are about to write. |
| */ |
| dd->ipath_eep_st_errs[idx] = new_val; |
| dd->ipath_eep_st_new_errs[idx] = 0; |
| } |
| } |
| /* |
| * now update active-time. We would like to round to the nearest hour |
| * but unless atomic_t are sure to be proper signed ints we cannot, |
| * because we need to account for what we "transfer" to EEPROM and |
| * if we log an hour at 31 minutes, then we would need to set |
| * active_time to -29 to accurately count the _next_ hour. |
| */ |
| if (new_time > 3600) { |
| new_hrs = new_time / 3600; |
| atomic_sub((new_hrs * 3600), &dd->ipath_active_time); |
| new_hrs += dd->ipath_eep_hrs; |
| if (new_hrs > 0xFFFF) |
| new_hrs = 0xFFFF; |
| dd->ipath_eep_hrs = new_hrs; |
| if ((new_hrs & 0xFF) != ifp->if_powerhour[0]) { |
| ifp->if_powerhour[0] = new_hrs & 0xFF; |
| hi_water = offsetof(struct ipath_flash, if_powerhour); |
| } |
| if ((new_hrs >> 8) != ifp->if_powerhour[1]) { |
| ifp->if_powerhour[1] = new_hrs >> 8; |
| hi_water = offsetof(struct ipath_flash, if_powerhour) |
| + 1; |
| } |
| } |
| /* |
| * There is a tiny possibility that we could somehow fail to write |
| * the EEPROM after updating our shadows, but problems from holding |
| * the spinlock too long are a much bigger issue. |
| */ |
| spin_unlock_irqrestore(&dd->ipath_eep_st_lock, flags); |
| if (hi_water) { |
| /* we made some change to the data, uopdate cksum and write */ |
| csum = flash_csum(ifp, 1); |
| ret = ipath_eeprom_internal_write(dd, 0, buf, hi_water + 1); |
| } |
| up(&dd->ipath_eep_sem); |
| if (ret) |
| ipath_dev_err(dd, "Failed updating EEPROM\n"); |
| |
| free_bail: |
| vfree(buf); |
| bail: |
| return ret; |
| |
| } |
| |
| /** |
| * ipath_inc_eeprom_err - increment one of the four error counters |
| * that are logged to EEPROM. |
| * @dd: the infinipath device |
| * @eidx: 0..3, the counter to increment |
| * @incr: how much to add |
| * |
| * Each counter is 8-bits, and saturates at 255 (0xFF). They |
| * are copied to the EEPROM (aka flash) whenever ipath_update_eeprom_log() |
| * is called, but it can only be called in a context that allows sleep. |
| * This function can be called even at interrupt level. |
| */ |
| |
| void ipath_inc_eeprom_err(struct ipath_devdata *dd, u32 eidx, u32 incr) |
| { |
| uint new_val; |
| unsigned long flags; |
| |
| spin_lock_irqsave(&dd->ipath_eep_st_lock, flags); |
| new_val = dd->ipath_eep_st_new_errs[eidx] + incr; |
| if (new_val > 255) |
| new_val = 255; |
| dd->ipath_eep_st_new_errs[eidx] = new_val; |
| spin_unlock_irqrestore(&dd->ipath_eep_st_lock, flags); |
| return; |
| } |