[AS7315-27XB] Fix build error and incorrect I2C bus number (#9712)
* Add intel_iommu=off to installer.conf * This solve flooding DMAR err msg: "handling fault status reg 2" Signed-off-by: Sean Wu <sean_wu@edge-core.com> * remove customized at24 driver * Use kernel 5.10.46 upstream at24 driver directly. The ADDR16 issue on old driver has gone. Signed-off-by: Sean Wu <sean_wu@edge-core.com> * pin I2C-0/I2C-1 bus order * otherwise, sometimes I2C-0/I2C-1 will be assigned to the undesired one. Signed-off-by: Sean Wu <sean_wu@edge-core.com> * fix i2c bus num for fan driver Signed-off-by: Sean Wu <sean_wu@edge-core.com> * backward compatible with R0A/R0B HW Signed-off-by: Sean Wu <sean_wu@edge-core.com>
This commit is contained in:
SeanWu
GitHub
parent
1b657becc9
commit
a2d1798a11
@ -1,2 +1,2 @@
|
|||||||
CONSOLE_SPEED=115200
|
CONSOLE_SPEED=115200
|
||||||
ONIE_PLATFORM_EXTRA_CMDLINE_LINUX="tg3.short_preamble=1 tg3.bcm5718s_reset=1"
|
ONIE_PLATFORM_EXTRA_CMDLINE_LINUX="tg3.short_preamble=1 tg3.bcm5718s_reset=1 intel_iommu=off modprobe.blacklist=i2c-ismt,i2c_ismt,i2c-i801,i2c_i801"
|
||||||
|
|||||||
@ -27,6 +27,7 @@ try:
|
|||||||
import time
|
import time
|
||||||
import logging
|
import logging
|
||||||
from collections import namedtuple
|
from collections import namedtuple
|
||||||
|
import subprocess
|
||||||
except ImportError as e:
|
except ImportError as e:
|
||||||
raise ImportError('%s - required module not found' % str(e))
|
raise ImportError('%s - required module not found' % str(e))
|
||||||
|
|
||||||
@ -44,8 +45,11 @@ class FanUtil(object):
|
|||||||
#FAN_NODE_DUTY_IDX_OF_MAP = 4
|
#FAN_NODE_DUTY_IDX_OF_MAP = 4
|
||||||
#FANR_NODE_FAULT_IDX_OF_MAP = 5
|
#FANR_NODE_FAULT_IDX_OF_MAP = 5
|
||||||
|
|
||||||
BASE_VAL_PATH = '/sys/bus/i2c/devices/50-0066/{0}'
|
I2CADDR_CANDIDATES = ((9, 66), # for R0C HW and later
|
||||||
FAN_DUTY_PATH = '/sys/bus/i2c/devices/50-0066/fan{0}_pwm'
|
(50, 66)) # for R0A, R0B HW
|
||||||
|
PATH_PREFIX = '/sys/bus/i2c/devices/{}-00{}/'
|
||||||
|
BASE_VAL_PATH = '{0}'
|
||||||
|
FAN_DUTY_PATH = 'fan{0}_pwm'
|
||||||
|
|
||||||
#logfile = ''
|
#logfile = ''
|
||||||
#loglevel = self.logger.INFO
|
#loglevel = self.logger.INFO
|
||||||
@ -59,6 +63,21 @@ class FanUtil(object):
|
|||||||
node_postfix = ["fault", "direction"]
|
node_postfix = ["fault", "direction"]
|
||||||
def _get_fan_to_device_node(self, fan_num, node_num):
|
def _get_fan_to_device_node(self, fan_num, node_num):
|
||||||
return "fan{0}_{1}".format(fan_num, self.node_postfix[node_num-1])
|
return "fan{0}_{1}".format(fan_num, self.node_postfix[node_num-1])
|
||||||
|
|
||||||
|
def _get_fan_i2c_bus_addr(self):
|
||||||
|
cmd_template = 'i2cget -f -y {} 0x{} 0'
|
||||||
|
for bus_no, dev_addr in self.I2CADDR_CANDIDATES:
|
||||||
|
cmd = cmd_template.format(bus_no, dev_addr)
|
||||||
|
if subprocess.getstatusoutput(cmd)[0] == 0:
|
||||||
|
return bus_no, dev_addr
|
||||||
|
raise IOError('Unable to reach fan CPLD via I2C')
|
||||||
|
|
||||||
|
def _init_fnode_basepath(self):
|
||||||
|
'''format BASE_VAL_PATH and FAN_DUTY_PATH '''
|
||||||
|
bus, addr = self._get_fan_i2c_bus_addr()
|
||||||
|
self.PATH_PREFIX = self.PATH_PREFIX.format(bus, addr)
|
||||||
|
self.BASE_VAL_PATH = self.PATH_PREFIX + self.BASE_VAL_PATH
|
||||||
|
self.FAN_DUTY_PATH = self.PATH_PREFIX + self.FAN_DUTY_PATH
|
||||||
|
|
||||||
def _get_fan_node_val(self, fan_num, node_num):
|
def _get_fan_node_val(self, fan_num, node_num):
|
||||||
if fan_num < self.FAN_NUM_1_IDX or fan_num > self.FAN_TOTAL_NUM:
|
if fan_num < self.FAN_NUM_1_IDX or fan_num > self.FAN_TOTAL_NUM:
|
||||||
@ -84,7 +103,7 @@ class FanUtil(object):
|
|||||||
return None
|
return None
|
||||||
|
|
||||||
try:
|
try:
|
||||||
val_file.close()
|
val_file.close()
|
||||||
except:
|
except:
|
||||||
self.logger.debug('GET. unable to close file. device_path:%s', device_path)
|
self.logger.debug('GET. unable to close file. device_path:%s', device_path)
|
||||||
return None
|
return None
|
||||||
@ -115,7 +134,7 @@ class FanUtil(object):
|
|||||||
val_file.write(content)
|
val_file.write(content)
|
||||||
|
|
||||||
try:
|
try:
|
||||||
val_file.close()
|
val_file.close()
|
||||||
except:
|
except:
|
||||||
self.logger.debug('GET. unable to close file. device_path:%s', device_path)
|
self.logger.debug('GET. unable to close file. device_path:%s', device_path)
|
||||||
return None
|
return None
|
||||||
@ -128,6 +147,7 @@ class FanUtil(object):
|
|||||||
ch.setLevel(log_level)
|
ch.setLevel(log_level)
|
||||||
self.logger.addHandler(ch)
|
self.logger.addHandler(ch)
|
||||||
|
|
||||||
|
self._init_fnode_basepath()
|
||||||
fan_path = self.BASE_VAL_PATH
|
fan_path = self.BASE_VAL_PATH
|
||||||
for fan_num in range(self.FAN_NUM_1_IDX, self.FAN_TOTAL_NUM+1):
|
for fan_num in range(self.FAN_NUM_1_IDX, self.FAN_TOTAL_NUM+1):
|
||||||
for node_num in range(1, self.FAN_NODE_NUM+1):
|
for node_num in range(1, self.FAN_NODE_NUM+1):
|
||||||
|
|||||||
@ -1,2 +1,2 @@
|
|||||||
obj-m:= accton_as7315_27xb_fan.o x86-64-accton-as7315-27xb-cpld.o x86-64-accton-as7315-27xb-psu.o \
|
obj-m:= accton_as7315_27xb_fan.o x86-64-accton-as7315-27xb-cpld.o x86-64-accton-as7315-27xb-psu.o \
|
||||||
at24_as7315_27xb.o x86-64-accton-as7315-27xb-led.o ym2651y.o
|
x86-64-accton-as7315-27xb-led.o ym2651y.o
|
||||||
|
|||||||
@ -1,695 +0,0 @@
|
|||||||
/*
|
|
||||||
* at24_as7315_27xb.c - handle most I2C EEPROMs for ethernet switch, as7315_27xb.
|
|
||||||
*
|
|
||||||
* Copyright (C) 2005-2007 David Brownell
|
|
||||||
* Copyright (C) 2008 Wolfram Sang, Pengutronix
|
|
||||||
* Copyright (C) 2019 Roy Lee, EdgeCore network.
|
|
||||||
* Revised to support specially I2C transactions, pure READ and WRITE.
|
|
||||||
*
|
|
||||||
* This program is free software; you can redistribute it and/or modify
|
|
||||||
* it under the terms of the GNU General Public License as published by
|
|
||||||
* the Free Software Foundation; either version 2 of the License, or
|
|
||||||
* (at your option) any later version.
|
|
||||||
*/
|
|
||||||
#include <linux/kernel.h>
|
|
||||||
#include <linux/init.h>
|
|
||||||
#include <linux/module.h>
|
|
||||||
#include <linux/slab.h>
|
|
||||||
#include <linux/delay.h>
|
|
||||||
#include <linux/mutex.h>
|
|
||||||
#include <linux/mod_devicetable.h>
|
|
||||||
#include <linux/log2.h>
|
|
||||||
#include <linux/bitops.h>
|
|
||||||
#include <linux/jiffies.h>
|
|
||||||
#include <linux/of.h>
|
|
||||||
#include <linux/acpi.h>
|
|
||||||
#include <linux/i2c.h>
|
|
||||||
#include <linux/nvmem-provider.h>
|
|
||||||
#include <linux/platform_data/at24.h>
|
|
||||||
#include <linux/printk.h>
|
|
||||||
#include <asm/uaccess.h>
|
|
||||||
/*
|
|
||||||
* I2C EEPROMs from most vendors are inexpensive and mostly interchangeable.
|
|
||||||
* Differences between different vendor product lines (like Atmel AT24C or
|
|
||||||
* MicroChip 24LC, etc) won't much matter for typical read/write access.
|
|
||||||
* There are also I2C RAM chips, likewise interchangeable. One example
|
|
||||||
* would be the PCF8570, which acts like a 24c02 EEPROM (256 bytes).
|
|
||||||
*
|
|
||||||
* However, misconfiguration can lose data. "Set 16-bit memory address"
|
|
||||||
* to a part with 8-bit addressing will overwrite data. Writing with too
|
|
||||||
* big a page size also loses data. And it's not safe to assume that the
|
|
||||||
* conventional addresses 0x50..0x57 only hold eeproms; a PCF8563 RTC
|
|
||||||
* uses 0x51, for just one example.
|
|
||||||
*
|
|
||||||
* Accordingly, explicit board-specific configuration data should be used
|
|
||||||
* in almost all cases. (One partial exception is an SMBus used to access
|
|
||||||
* "SPD" data for DRAM sticks. Those only use 24c02 EEPROMs.)
|
|
||||||
*
|
|
||||||
* So this driver uses "new style" I2C driver binding, expecting to be
|
|
||||||
* told what devices exist. That may be in arch/X/mach-Y/board-Z.c or
|
|
||||||
* similar kernel-resident tables; or, configuration data coming from
|
|
||||||
* a bootloader.
|
|
||||||
*
|
|
||||||
* Other than binding model, current differences from "eeprom" driver are
|
|
||||||
* that this one handles write access and isn't restricted to 24c02 devices.
|
|
||||||
* It also handles larger devices (32 kbit and up) with two-byte addresses,
|
|
||||||
* which won't work on pure SMBus systems.
|
|
||||||
*/
|
|
||||||
|
|
||||||
struct at24_data {
|
|
||||||
struct at24_platform_data chip;
|
|
||||||
int use_smbus;
|
|
||||||
int use_smbus_write;
|
|
||||||
|
|
||||||
ssize_t (*read_func)(struct at24_data *, char *, unsigned int, size_t);
|
|
||||||
ssize_t (*write_func)(struct at24_data *,
|
|
||||||
const char *, unsigned int, size_t);
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Lock protects against activities from other Linux tasks,
|
|
||||||
* but not from changes by other I2C masters.
|
|
||||||
*/
|
|
||||||
struct mutex lock;
|
|
||||||
|
|
||||||
u8 *writebuf;
|
|
||||||
unsigned write_max;
|
|
||||||
unsigned num_addresses;
|
|
||||||
|
|
||||||
struct nvmem_config nvmem_config;
|
|
||||||
struct nvmem_device *nvmem;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Some chips tie up multiple I2C addresses; dummy devices reserve
|
|
||||||
* them for us, and we'll use them with SMBus calls.
|
|
||||||
*/
|
|
||||||
struct i2c_client *client[];
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* This parameter is to help this driver avoid blocking other drivers out
|
|
||||||
* of I2C for potentially troublesome amounts of time. With a 100 kHz I2C
|
|
||||||
* clock, one 256 byte read takes about 1/43 second which is excessive;
|
|
||||||
* but the 1/170 second it takes at 400 kHz may be quite reasonable; and
|
|
||||||
* at 1 MHz (Fm+) a 1/430 second delay could easily be invisible.
|
|
||||||
*
|
|
||||||
* This value is forced to be a power of two so that writes align on pages.
|
|
||||||
*/
|
|
||||||
static unsigned io_limit = 128;
|
|
||||||
module_param(io_limit, uint, 0);
|
|
||||||
MODULE_PARM_DESC(io_limit, "Maximum bytes per I/O (default 128)");
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Specs often allow 5 msec for a page write, sometimes 20 msec;
|
|
||||||
* it's important to recover from write timeouts.
|
|
||||||
*/
|
|
||||||
static unsigned write_timeout = 25;
|
|
||||||
module_param(write_timeout, uint, 0);
|
|
||||||
MODULE_PARM_DESC(write_timeout, "Time (in ms) to try writes (default 25)");
|
|
||||||
|
|
||||||
#define AT24_SIZE_BYTELEN 5
|
|
||||||
#define AT24_SIZE_FLAGS 8
|
|
||||||
|
|
||||||
#define AT24_BITMASK(x) (BIT(x) - 1)
|
|
||||||
|
|
||||||
/* create non-zero magic value for given eeprom parameters */
|
|
||||||
#define AT24_DEVICE_MAGIC(_len, _flags) \
|
|
||||||
((1 << AT24_SIZE_FLAGS | (_flags)) \
|
|
||||||
<< AT24_SIZE_BYTELEN | ilog2(_len))
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Both reads and writes fail if the previous write didn't complete yet. This
|
|
||||||
* macro loops a few times waiting at least long enough for one entire page
|
|
||||||
* write to work while making sure that at least one iteration is run before
|
|
||||||
* checking the break condition.
|
|
||||||
*
|
|
||||||
* It takes two parameters: a variable in which the future timeout in jiffies
|
|
||||||
* will be stored and a temporary variable holding the time of the last
|
|
||||||
* iteration of processing the request. Both should be unsigned integers
|
|
||||||
* holding at least 32 bits.
|
|
||||||
*/
|
|
||||||
#define loop_until_timeout(tout, op_time) \
|
|
||||||
for (tout = jiffies + msecs_to_jiffies(write_timeout), op_time = 0; \
|
|
||||||
op_time ? time_before(op_time, tout) : true; \
|
|
||||||
usleep_range(1000, 1500), op_time = jiffies)
|
|
||||||
|
|
||||||
static const struct i2c_device_id at24_ids[] = {
|
|
||||||
{ "24cxb04", AT24_DEVICE_MAGIC(4096 / 8, AT24_FLAG_ADDR16) },
|
|
||||||
{ "24cxb08", AT24_DEVICE_MAGIC(8192 / 8, AT24_FLAG_ADDR16) },
|
|
||||||
{ "24cxb16", AT24_DEVICE_MAGIC(16384 / 8, AT24_FLAG_ADDR16) },
|
|
||||||
{ "24cxb32", AT24_DEVICE_MAGIC(32768 / 8, AT24_FLAG_ADDR16) },
|
|
||||||
{ "24cxb64", AT24_DEVICE_MAGIC(65536 / 8, AT24_FLAG_ADDR16) },
|
|
||||||
{ "at24", 0 },
|
|
||||||
{ /* END OF LIST */ }
|
|
||||||
};
|
|
||||||
MODULE_DEVICE_TABLE(i2c, at24_ids);
|
|
||||||
|
|
||||||
static const struct acpi_device_id at24_acpi_ids[] = {
|
|
||||||
{ "INT3499", AT24_DEVICE_MAGIC(8192 / 8, 0) },
|
|
||||||
{ }
|
|
||||||
};
|
|
||||||
MODULE_DEVICE_TABLE(acpi, at24_acpi_ids);
|
|
||||||
|
|
||||||
/*-------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
/*
|
|
||||||
* This routine supports chips which consume multiple I2C addresses. It
|
|
||||||
* computes the addressing information to be used for a given r/w request.
|
|
||||||
* Assumes that sanity checks for offset happened at sysfs-layer.
|
|
||||||
*
|
|
||||||
* Slave address and byte offset derive from the offset. Always
|
|
||||||
* set the byte address; on a multi-master board, another master
|
|
||||||
* may have changed the chip's "current" address pointer.
|
|
||||||
*
|
|
||||||
* REVISIT some multi-address chips don't rollover page reads to
|
|
||||||
* the next slave address, so we may need to truncate the count.
|
|
||||||
* Those chips might need another quirk flag.
|
|
||||||
*
|
|
||||||
* If the real hardware used four adjacent 24c02 chips and that
|
|
||||||
* were misconfigured as one 24c08, that would be a similar effect:
|
|
||||||
* one "eeprom" file not four, but larger reads would fail when
|
|
||||||
* they crossed certain pages.
|
|
||||||
*/
|
|
||||||
static struct i2c_client *at24_translate_offset(struct at24_data *at24,
|
|
||||||
unsigned int *offset)
|
|
||||||
{
|
|
||||||
unsigned i;
|
|
||||||
|
|
||||||
/*Always AT24_FLAG_ADDR16*/
|
|
||||||
i = *offset >> 16;
|
|
||||||
*offset &= 0xffff;
|
|
||||||
|
|
||||||
return at24->client[i];
|
|
||||||
}
|
|
||||||
|
|
||||||
static ssize_t at24_eeprom_read_smbus(struct at24_data *at24, char *buf,
|
|
||||||
unsigned int offset, size_t count)
|
|
||||||
{
|
|
||||||
unsigned long timeout, read_time;
|
|
||||||
struct i2c_client *client;
|
|
||||||
int status;
|
|
||||||
client = at24_translate_offset(at24, &offset);
|
|
||||||
|
|
||||||
if (count > io_limit)
|
|
||||||
count = io_limit;
|
|
||||||
|
|
||||||
loop_until_timeout(timeout, read_time) {
|
|
||||||
/*
|
|
||||||
status = i2c_smbus_read_i2c_block_data_or_emulated(client,
|
|
||||||
offset,
|
|
||||||
count, buf);
|
|
||||||
|
|
||||||
dev_dbg(&client->dev, "read %zu@%d --> %d (%ld)\n",
|
|
||||||
count, offset, status, jiffies);
|
|
||||||
*/
|
|
||||||
int i=0;
|
|
||||||
|
|
||||||
/*Write 2-byte offset*/
|
|
||||||
unsigned char bb = offset&0xff;
|
|
||||||
status = i2c_smbus_write_i2c_block_data(client, offset>>8, 1, &bb);
|
|
||||||
if (status < 0) {
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
while (i < count) {
|
|
||||||
status = i2c_smbus_read_byte(client);
|
|
||||||
if (status < 0) {
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
buf[i] = status;
|
|
||||||
i++;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
if (i == count)
|
|
||||||
return count;
|
|
||||||
}
|
|
||||||
|
|
||||||
return -ETIMEDOUT;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Note that if the hardware write-protect pin is pulled high, the whole
|
|
||||||
* chip is normally write protected. But there are plenty of product
|
|
||||||
* variants here, including OTP fuses and partial chip protect.
|
|
||||||
*
|
|
||||||
* We only use page mode writes; the alternative is sloooow. These routines
|
|
||||||
* write at most one page.
|
|
||||||
*/
|
|
||||||
|
|
||||||
static size_t at24_adjust_write_count(struct at24_data *at24,
|
|
||||||
unsigned int offset, size_t count)
|
|
||||||
{
|
|
||||||
unsigned next_page;
|
|
||||||
|
|
||||||
/* write_max is at most a page */
|
|
||||||
if (count > at24->write_max)
|
|
||||||
count = at24->write_max;
|
|
||||||
|
|
||||||
/* Never roll over backwards, to the start of this page */
|
|
||||||
next_page = roundup(offset + 1, at24->chip.page_size);
|
|
||||||
if (offset + count > next_page)
|
|
||||||
count = next_page - offset;
|
|
||||||
|
|
||||||
return count;
|
|
||||||
}
|
|
||||||
|
|
||||||
static ssize_t at24_eeprom_write_smbus_block(struct at24_data *at24,
|
|
||||||
const char *buf,
|
|
||||||
unsigned int offset, size_t count)
|
|
||||||
{
|
|
||||||
unsigned long timeout, write_time;
|
|
||||||
struct i2c_client *client;
|
|
||||||
ssize_t status = 0;
|
|
||||||
|
|
||||||
client = at24_translate_offset(at24, &offset);
|
|
||||||
count = at24_adjust_write_count(at24, offset, count);
|
|
||||||
|
|
||||||
loop_until_timeout(timeout, write_time) {
|
|
||||||
status = i2c_smbus_write_i2c_block_data(client,
|
|
||||||
offset, count, buf);
|
|
||||||
if (status == 0)
|
|
||||||
status = count;
|
|
||||||
|
|
||||||
dev_dbg(&client->dev, "write %zu@%d --> %zd (%ld)\n",
|
|
||||||
count, offset, status, jiffies);
|
|
||||||
|
|
||||||
if (status == count)
|
|
||||||
return count;
|
|
||||||
}
|
|
||||||
|
|
||||||
return -ETIMEDOUT;
|
|
||||||
}
|
|
||||||
|
|
||||||
static ssize_t at24_eeprom_write_smbus_byte(struct at24_data *at24,
|
|
||||||
const char *buf,
|
|
||||||
unsigned int offset, size_t count)
|
|
||||||
{
|
|
||||||
unsigned long timeout, write_time;
|
|
||||||
struct i2c_client *client;
|
|
||||||
ssize_t status = 0;
|
|
||||||
|
|
||||||
client = at24_translate_offset(at24, &offset);
|
|
||||||
|
|
||||||
loop_until_timeout(timeout, write_time) {
|
|
||||||
status = i2c_smbus_write_byte_data(client, offset, buf[0]);
|
|
||||||
if (status == 0)
|
|
||||||
status = count;
|
|
||||||
|
|
||||||
dev_dbg(&client->dev, "write %zu@%d --> %zd (%ld)\n",
|
|
||||||
count, offset, status, jiffies);
|
|
||||||
|
|
||||||
if (status == count)
|
|
||||||
return count;
|
|
||||||
}
|
|
||||||
|
|
||||||
return -ETIMEDOUT;
|
|
||||||
}
|
|
||||||
|
|
||||||
static ssize_t at24_eeprom_write_i2c(struct at24_data *at24, const char *buf,
|
|
||||||
unsigned int offset, size_t count)
|
|
||||||
{
|
|
||||||
unsigned long timeout, write_time;
|
|
||||||
struct i2c_client *client;
|
|
||||||
struct i2c_msg msg;
|
|
||||||
ssize_t status = 0;
|
|
||||||
int i = 0;
|
|
||||||
|
|
||||||
client = at24_translate_offset(at24, &offset);
|
|
||||||
count = at24_adjust_write_count(at24, offset, count);
|
|
||||||
|
|
||||||
msg.addr = client->addr;
|
|
||||||
msg.flags = 0;
|
|
||||||
|
|
||||||
/* msg.buf is u8 and casts will mask the values */
|
|
||||||
msg.buf = at24->writebuf;
|
|
||||||
if (at24->chip.flags & AT24_FLAG_ADDR16)
|
|
||||||
msg.buf[i++] = offset >> 8;
|
|
||||||
|
|
||||||
msg.buf[i++] = offset;
|
|
||||||
memcpy(&msg.buf[i], buf, count);
|
|
||||||
msg.len = i + count;
|
|
||||||
|
|
||||||
loop_until_timeout(timeout, write_time) {
|
|
||||||
status = i2c_transfer(client->adapter, &msg, 1);
|
|
||||||
if (status == 1)
|
|
||||||
status = count;
|
|
||||||
|
|
||||||
dev_dbg(&client->dev, "write %zu@%d --> %zd (%ld)\n",
|
|
||||||
count, offset, status, jiffies);
|
|
||||||
|
|
||||||
if (status == count)
|
|
||||||
return count;
|
|
||||||
}
|
|
||||||
|
|
||||||
return -ETIMEDOUT;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int at24_read(void *priv, unsigned int off, void *val, size_t count)
|
|
||||||
{
|
|
||||||
struct at24_data *at24 = priv;
|
|
||||||
char *buf = val;
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
if (unlikely(!count))
|
|
||||||
return count;
|
|
||||||
|
|
||||||
if (off + count > at24->chip.byte_len)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Read data from chip, protecting against concurrent updates
|
|
||||||
* from this host, but not from other I2C masters.
|
|
||||||
*/
|
|
||||||
mutex_lock(&at24->lock);
|
|
||||||
|
|
||||||
while (count) {
|
|
||||||
int status;
|
|
||||||
|
|
||||||
status = at24->read_func(at24, buf, off, count);
|
|
||||||
if (status < 0) {
|
|
||||||
mutex_unlock(&at24->lock);
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
buf += status;
|
|
||||||
off += status;
|
|
||||||
count -= status;
|
|
||||||
}
|
|
||||||
|
|
||||||
mutex_unlock(&at24->lock);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int at24_write(void *priv, unsigned int off, void *val, size_t count)
|
|
||||||
{
|
|
||||||
struct at24_data *at24 = priv;
|
|
||||||
char *buf = val;
|
|
||||||
|
|
||||||
if (unlikely(!count))
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
if (off + count > at24->chip.byte_len)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Write data to chip, protecting against concurrent updates
|
|
||||||
* from this host, but not from other I2C masters.
|
|
||||||
*/
|
|
||||||
mutex_lock(&at24->lock);
|
|
||||||
|
|
||||||
while (count) {
|
|
||||||
int status;
|
|
||||||
|
|
||||||
status = at24->write_func(at24, buf, off, count);
|
|
||||||
if (status < 0) {
|
|
||||||
mutex_unlock(&at24->lock);
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
buf += status;
|
|
||||||
off += status;
|
|
||||||
count -= status;
|
|
||||||
}
|
|
||||||
|
|
||||||
mutex_unlock(&at24->lock);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifdef CONFIG_OF
|
|
||||||
static void at24_get_ofdata(struct i2c_client *client,
|
|
||||||
struct at24_platform_data *chip)
|
|
||||||
{
|
|
||||||
const __be32 *val;
|
|
||||||
struct device_node *node = client->dev.of_node;
|
|
||||||
|
|
||||||
if (node) {
|
|
||||||
if (of_get_property(node, "read-only", NULL))
|
|
||||||
chip->flags |= AT24_FLAG_READONLY;
|
|
||||||
val = of_get_property(node, "pagesize", NULL);
|
|
||||||
if (val)
|
|
||||||
chip->page_size = be32_to_cpup(val);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#else
|
|
||||||
static void at24_get_ofdata(struct i2c_client *client,
|
|
||||||
struct at24_platform_data *chip)
|
|
||||||
{ }
|
|
||||||
#endif /* CONFIG_OF */
|
|
||||||
|
|
||||||
static int at24_probe(struct i2c_client *client, const struct i2c_device_id *id)
|
|
||||||
{
|
|
||||||
struct at24_platform_data chip;
|
|
||||||
kernel_ulong_t magic = 0;
|
|
||||||
bool writable;
|
|
||||||
int use_smbus = 0;
|
|
||||||
int use_smbus_write = 0;
|
|
||||||
struct at24_data *at24;
|
|
||||||
int err;
|
|
||||||
unsigned i, num_addresses;
|
|
||||||
|
|
||||||
if (client->dev.platform_data) {
|
|
||||||
chip = *(struct at24_platform_data *)client->dev.platform_data;
|
|
||||||
} else {
|
|
||||||
if (id) {
|
|
||||||
magic = id->driver_data;
|
|
||||||
} else {
|
|
||||||
const struct acpi_device_id *aid;
|
|
||||||
|
|
||||||
aid = acpi_match_device(at24_acpi_ids, &client->dev);
|
|
||||||
if (aid)
|
|
||||||
magic = aid->driver_data;
|
|
||||||
}
|
|
||||||
if (!magic)
|
|
||||||
return -ENODEV;
|
|
||||||
|
|
||||||
chip.byte_len = BIT(magic & AT24_BITMASK(AT24_SIZE_BYTELEN));
|
|
||||||
magic >>= AT24_SIZE_BYTELEN;
|
|
||||||
chip.flags = magic & AT24_BITMASK(AT24_SIZE_FLAGS);
|
|
||||||
/*
|
|
||||||
* This is slow, but we can't know all eeproms, so we better
|
|
||||||
* play safe. Specifying custom eeprom-types via platform_data
|
|
||||||
* is recommended anyhow.
|
|
||||||
*/
|
|
||||||
chip.page_size = 1;
|
|
||||||
|
|
||||||
/* update chipdata if OF is present */
|
|
||||||
at24_get_ofdata(client, &chip);
|
|
||||||
|
|
||||||
chip.setup = NULL;
|
|
||||||
chip.context = NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (!is_power_of_2(chip.byte_len))
|
|
||||||
dev_warn(&client->dev,
|
|
||||||
"byte_len looks suspicious (no power of 2)!\n");
|
|
||||||
if (!chip.page_size) {
|
|
||||||
dev_err(&client->dev, "page_size must not be 0!\n");
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
if (!is_power_of_2(chip.page_size))
|
|
||||||
dev_warn(&client->dev,
|
|
||||||
"page_size looks suspicious (no power of 2)!\n");
|
|
||||||
|
|
||||||
/*
|
|
||||||
* REVISIT: the size of the EUI-48 byte array is 6 in at24mac402, while
|
|
||||||
* the call to ilog2() in AT24_DEVICE_MAGIC() rounds it down to 4.
|
|
||||||
*
|
|
||||||
* Eventually we'll get rid of the magic values altoghether in favor of
|
|
||||||
* real structs, but for now just manually set the right size.
|
|
||||||
*/
|
|
||||||
if (chip.flags & AT24_FLAG_MAC && chip.byte_len == 4)
|
|
||||||
chip.byte_len = 6;
|
|
||||||
|
|
||||||
/* Use I2C operations unless we're stuck with SMBus extensions. */
|
|
||||||
if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
|
|
||||||
/*if (chip.flags & AT24_FLAG_ADDR16){
|
|
||||||
return -EPFNOSUPPORT;
|
|
||||||
}*/
|
|
||||||
if (i2c_check_functionality(client->adapter,
|
|
||||||
I2C_FUNC_SMBUS_READ_I2C_BLOCK)) {
|
|
||||||
use_smbus = I2C_SMBUS_I2C_BLOCK_DATA;
|
|
||||||
} else if (i2c_check_functionality(client->adapter,
|
|
||||||
I2C_FUNC_SMBUS_READ_WORD_DATA)) {
|
|
||||||
use_smbus = I2C_SMBUS_WORD_DATA;
|
|
||||||
} else if (i2c_check_functionality(client->adapter,
|
|
||||||
I2C_FUNC_SMBUS_READ_BYTE_DATA)) {
|
|
||||||
use_smbus = I2C_SMBUS_BYTE_DATA;
|
|
||||||
} else {
|
|
||||||
return -EPFNOSUPPORT;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (i2c_check_functionality(client->adapter,
|
|
||||||
I2C_FUNC_SMBUS_WRITE_I2C_BLOCK)) {
|
|
||||||
use_smbus_write = I2C_SMBUS_I2C_BLOCK_DATA;
|
|
||||||
} else if (i2c_check_functionality(client->adapter,
|
|
||||||
I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) {
|
|
||||||
use_smbus_write = I2C_SMBUS_BYTE_DATA;
|
|
||||||
chip.page_size = 1;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if (chip.flags & AT24_FLAG_TAKE8ADDR)
|
|
||||||
num_addresses = 8;
|
|
||||||
else
|
|
||||||
num_addresses = DIV_ROUND_UP(chip.byte_len,
|
|
||||||
(chip.flags & AT24_FLAG_ADDR16) ? 65536 : 256);
|
|
||||||
|
|
||||||
at24 = devm_kzalloc(&client->dev, sizeof(struct at24_data) +
|
|
||||||
num_addresses * sizeof(struct i2c_client *), GFP_KERNEL);
|
|
||||||
if (!at24)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
mutex_init(&at24->lock);
|
|
||||||
at24->use_smbus = use_smbus;
|
|
||||||
at24->use_smbus_write = use_smbus_write;
|
|
||||||
at24->chip = chip;
|
|
||||||
at24->num_addresses = num_addresses;
|
|
||||||
|
|
||||||
if ((chip.flags & AT24_FLAG_SERIAL) && (chip.flags & AT24_FLAG_MAC)) {
|
|
||||||
dev_err(&client->dev,
|
|
||||||
"invalid device data - cannot have both AT24_FLAG_SERIAL & AT24_FLAG_MAC.");
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
at24->read_func = at24_eeprom_read_smbus;
|
|
||||||
|
|
||||||
if (at24->use_smbus) {
|
|
||||||
if (at24->use_smbus_write == I2C_SMBUS_I2C_BLOCK_DATA)
|
|
||||||
at24->write_func = at24_eeprom_write_smbus_block;
|
|
||||||
else
|
|
||||||
at24->write_func = at24_eeprom_write_smbus_byte;
|
|
||||||
} else {
|
|
||||||
at24->write_func = at24_eeprom_write_i2c;
|
|
||||||
}
|
|
||||||
|
|
||||||
writable = !(chip.flags & AT24_FLAG_READONLY);
|
|
||||||
if (writable) {
|
|
||||||
if (!use_smbus || use_smbus_write) {
|
|
||||||
|
|
||||||
unsigned write_max = chip.page_size;
|
|
||||||
|
|
||||||
if (write_max > io_limit)
|
|
||||||
write_max = io_limit;
|
|
||||||
if (use_smbus && write_max > I2C_SMBUS_BLOCK_MAX)
|
|
||||||
write_max = I2C_SMBUS_BLOCK_MAX;
|
|
||||||
at24->write_max = write_max;
|
|
||||||
|
|
||||||
/* buffer (data + address at the beginning) */
|
|
||||||
at24->writebuf = devm_kzalloc(&client->dev,
|
|
||||||
write_max + 2, GFP_KERNEL);
|
|
||||||
if (!at24->writebuf)
|
|
||||||
return -ENOMEM;
|
|
||||||
} else {
|
|
||||||
dev_warn(&client->dev,
|
|
||||||
"cannot write due to controller restrictions.");
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
at24->client[0] = client;
|
|
||||||
|
|
||||||
/* use dummy devices for multiple-address chips */
|
|
||||||
for (i = 1; i < num_addresses; i++) {
|
|
||||||
at24->client[i] = i2c_new_dummy(client->adapter,
|
|
||||||
client->addr + i);
|
|
||||||
if (!at24->client[i]) {
|
|
||||||
dev_err(&client->dev, "address 0x%02x unavailable\n",
|
|
||||||
client->addr + i);
|
|
||||||
err = -EADDRINUSE;
|
|
||||||
goto err_clients;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
i2c_set_clientdata(client, at24);
|
|
||||||
at24->nvmem_config.name = dev_name(&client->dev);
|
|
||||||
at24->nvmem_config.dev = &client->dev;
|
|
||||||
at24->nvmem_config.read_only = !writable;
|
|
||||||
at24->nvmem_config.root_only = true;
|
|
||||||
at24->nvmem_config.owner = THIS_MODULE;
|
|
||||||
at24->nvmem_config.compat = true;
|
|
||||||
at24->nvmem_config.base_dev = &client->dev;
|
|
||||||
at24->nvmem_config.reg_read = at24_read;
|
|
||||||
at24->nvmem_config.reg_write = at24_write;
|
|
||||||
at24->nvmem_config.priv = at24;
|
|
||||||
at24->nvmem_config.stride = 1;
|
|
||||||
at24->nvmem_config.word_size = 1;
|
|
||||||
at24->nvmem_config.size = chip.byte_len;
|
|
||||||
|
|
||||||
at24->nvmem = nvmem_register(&at24->nvmem_config);
|
|
||||||
|
|
||||||
if (IS_ERR(at24->nvmem)) {
|
|
||||||
err = PTR_ERR(at24->nvmem);
|
|
||||||
goto err_clients;
|
|
||||||
}
|
|
||||||
|
|
||||||
dev_info(&client->dev, "%u byte %s EEPROM, %s, %u bytes/write\n",
|
|
||||||
chip.byte_len, client->name,
|
|
||||||
writable ? "writable" : "read-only", at24->write_max);
|
|
||||||
if (use_smbus == I2C_SMBUS_WORD_DATA ||
|
|
||||||
use_smbus == I2C_SMBUS_BYTE_DATA) {
|
|
||||||
dev_notice(&client->dev, "Falling back to %s reads, "
|
|
||||||
"performance will suffer\n", use_smbus ==
|
|
||||||
I2C_SMBUS_WORD_DATA ? "word" : "byte");
|
|
||||||
}
|
|
||||||
|
|
||||||
/* export data to kernel code */
|
|
||||||
if (chip.setup)
|
|
||||||
chip.setup(at24->nvmem, chip.context);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
err_clients:
|
|
||||||
for (i = 1; i < num_addresses; i++)
|
|
||||||
if (at24->client[i])
|
|
||||||
i2c_unregister_device(at24->client[i]);
|
|
||||||
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int at24_remove(struct i2c_client *client)
|
|
||||||
{
|
|
||||||
struct at24_data *at24;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
at24 = i2c_get_clientdata(client);
|
|
||||||
|
|
||||||
nvmem_unregister(at24->nvmem);
|
|
||||||
|
|
||||||
for (i = 1; i < at24->num_addresses; i++)
|
|
||||||
i2c_unregister_device(at24->client[i]);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*-------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
static struct i2c_driver at24_as7315_27xb_driver = {
|
|
||||||
.driver = {
|
|
||||||
.name = "at24_as7315_27xb",
|
|
||||||
.acpi_match_table = ACPI_PTR(at24_acpi_ids),
|
|
||||||
},
|
|
||||||
.probe = at24_probe,
|
|
||||||
.remove = at24_remove,
|
|
||||||
.id_table = at24_ids,
|
|
||||||
};
|
|
||||||
|
|
||||||
static int __init at24_as7315_27xb_init(void)
|
|
||||||
{
|
|
||||||
if (!io_limit) {
|
|
||||||
pr_err("at24_as7315_27xb: io_limit must not be 0!\n");
|
|
||||||
return -EINVAL;
|
|
||||||
}
|
|
||||||
|
|
||||||
io_limit = rounddown_pow_of_two(io_limit);
|
|
||||||
return i2c_add_driver(&at24_as7315_27xb_driver);
|
|
||||||
}
|
|
||||||
module_init(at24_as7315_27xb_init);
|
|
||||||
|
|
||||||
static void __exit at24_as7315_27xb_exit(void)
|
|
||||||
{
|
|
||||||
i2c_del_driver(&at24_as7315_27xb_driver);
|
|
||||||
}
|
|
||||||
module_exit(at24_as7315_27xb_exit);
|
|
||||||
|
|
||||||
MODULE_DESCRIPTION("Driver for I2C EEPROMs on accton switch, as7315_27xb");
|
|
||||||
MODULE_AUTHOR("Roy Lee");
|
|
||||||
MODULE_LICENSE("GPL");
|
|
||||||
@ -159,10 +159,11 @@ def driver_check():
|
|||||||
kos = [
|
kos = [
|
||||||
'modprobe i2c_dev',
|
'modprobe i2c_dev',
|
||||||
'modprobe i2c_mux_pca954x',
|
'modprobe i2c_mux_pca954x',
|
||||||
|
'modprobe i2c_ismt',
|
||||||
|
'modprobe i2c_i801',
|
||||||
'modprobe optoe',
|
'modprobe optoe',
|
||||||
'modprobe ym2651y',
|
'modprobe ym2651y',
|
||||||
'modprobe accton_as7315_27xb_fan',
|
'modprobe accton_as7315_27xb_fan',
|
||||||
'modprobe at24_as7315_27xb',
|
|
||||||
'modprobe x86-64-accton-as7315_27xb-cpld',
|
'modprobe x86-64-accton-as7315_27xb-cpld',
|
||||||
'modprobe x86-64-accton-as7315_27xb-led',
|
'modprobe x86-64-accton-as7315_27xb-led',
|
||||||
'modprobe x86-64-accton-as7315_27xb-psu' ]
|
'modprobe x86-64-accton-as7315_27xb-psu' ]
|
||||||
@ -227,12 +228,13 @@ mknod =[
|
|||||||
'echo as7315_cpld1 0x63 > /sys/bus/i2c/devices/i2c-8/new_device',
|
'echo as7315_cpld1 0x63 > /sys/bus/i2c/devices/i2c-8/new_device',
|
||||||
'echo as7315_cpld2 0x64 > /sys/bus/i2c/devices/i2c-7/new_device',
|
'echo as7315_cpld2 0x64 > /sys/bus/i2c/devices/i2c-7/new_device',
|
||||||
|
|
||||||
'echo 24cxb04 0x57 > /sys/bus/i2c/devices/i2c-4/new_device',
|
'echo 24c32 0x57 > /sys/bus/i2c/devices/i2c-4/new_device',
|
||||||
'echo as7315_27xb_psu2 0x50 > /sys/bus/i2c/devices/i2c-12/new_device',
|
'echo as7315_27xb_psu2 0x50 > /sys/bus/i2c/devices/i2c-12/new_device',
|
||||||
'echo ym2401 0x58 > /sys/bus/i2c/devices/i2c-12/new_device',
|
'echo ym2401 0x58 > /sys/bus/i2c/devices/i2c-12/new_device',
|
||||||
'echo as7315_27xb_psu1 0x53 > /sys/bus/i2c/devices/i2c-13/new_device',
|
'echo as7315_27xb_psu1 0x53 > /sys/bus/i2c/devices/i2c-13/new_device',
|
||||||
'echo ym2401 0x5b > /sys/bus/i2c/devices/i2c-13/new_device',
|
'echo ym2401 0x5b > /sys/bus/i2c/devices/i2c-13/new_device',
|
||||||
'echo as7315_fan 0x66 > /sys/bus/i2c/devices/i2c-50/new_device',
|
'echo as7315_fan 0x66 > /sys/bus/i2c/devices/i2c-50/new_device', # for R0A, R0B HW
|
||||||
|
'echo as7315_fan 0x66 > /sys/bus/i2c/devices/i2c-9/new_device', # for R0C HW and later
|
||||||
'echo lm75 0x49 > /sys/bus/i2c/devices/i2c-51/new_device',
|
'echo lm75 0x49 > /sys/bus/i2c/devices/i2c-51/new_device',
|
||||||
'echo lm75 0x4a > /sys/bus/i2c/devices/i2c-52/new_device',
|
'echo lm75 0x4a > /sys/bus/i2c/devices/i2c-52/new_device',
|
||||||
'echo lm75 0x4c > /sys/bus/i2c/devices/i2c-53/new_device',
|
'echo lm75 0x4c > /sys/bus/i2c/devices/i2c-53/new_device',
|
||||||
|
|||||||
Reference in New Issue
Block a user