mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-19 00:18:51 +09:00
![Tom Rini](/assets/img/avatar_default.png)
When U-Boot started using SPDX tags we were among the early adopters and there weren't a lot of other examples to borrow from. So we picked the area of the file that usually had a full license text and replaced it with an appropriate SPDX-License-Identifier: entry. Since then, the Linux Kernel has adopted SPDX tags and they place it as the very first line in a file (except where shebangs are used, then it's second line) and with slightly different comment styles than us. In part due to community overlap, in part due to better tag visibility and in part for other minor reasons, switch over to that style. This commit changes all instances where we have a single declared license in the tag as both the before and after are identical in tag contents. There's also a few places where I found we did not have a tag and have introduced one. Signed-off-by: Tom Rini <trini@konsulko.com>
466 lines
11 KiB
C
466 lines
11 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* (C) Copyright 2013
|
|
* Dirk Eibach, Guntermann & Drunck GmbH, dirk.eibach@gdsys.cc
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <i2c.h>
|
|
#ifdef CONFIG_DM_I2C
|
|
#include <dm.h>
|
|
#include <fpgamap.h>
|
|
#include "../misc/gdsys_soc.h"
|
|
#else
|
|
#include <gdsys_fpga.h>
|
|
#endif
|
|
#include <asm/unaligned.h>
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
struct ihs_i2c_priv {
|
|
uint speed;
|
|
phys_addr_t addr;
|
|
};
|
|
|
|
enum {
|
|
REG_INTERRUPT_STATUS = 0x00,
|
|
REG_INTERRUPT_ENABLE_CONTROL = 0x02,
|
|
REG_WRITE_MAILBOX_EXT = 0x04,
|
|
REG_WRITE_MAILBOX = 0x06,
|
|
REG_READ_MAILBOX_EXT = 0x08,
|
|
REG_READ_MAILBOX = 0x0A,
|
|
};
|
|
|
|
#else /* !CONFIG_DM_I2C */
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
#ifdef CONFIG_SYS_I2C_IHS_DUAL
|
|
|
|
#define I2C_SET_REG(fld, val) \
|
|
do { \
|
|
if (I2C_ADAP_HWNR & 0x10) \
|
|
FPGA_SET_REG(I2C_ADAP_HWNR & 0xf, i2c1.fld, val); \
|
|
else \
|
|
FPGA_SET_REG(I2C_ADAP_HWNR, i2c0.fld, val); \
|
|
} while (0)
|
|
#else
|
|
#define I2C_SET_REG(fld, val) \
|
|
FPGA_SET_REG(I2C_ADAP_HWNR, i2c0.fld, val)
|
|
#endif
|
|
|
|
#ifdef CONFIG_SYS_I2C_IHS_DUAL
|
|
#define I2C_GET_REG(fld, val) \
|
|
do { \
|
|
if (I2C_ADAP_HWNR & 0x10) \
|
|
FPGA_GET_REG(I2C_ADAP_HWNR & 0xf, i2c1.fld, val); \
|
|
else \
|
|
FPGA_GET_REG(I2C_ADAP_HWNR, i2c0.fld, val); \
|
|
} while (0)
|
|
#else
|
|
#define I2C_GET_REG(fld, val) \
|
|
FPGA_GET_REG(I2C_ADAP_HWNR, i2c0.fld, val)
|
|
#endif
|
|
#endif /* CONFIG_DM_I2C */
|
|
|
|
enum {
|
|
I2CINT_ERROR_EV = BIT(13),
|
|
I2CINT_TRANSMIT_EV = BIT(14),
|
|
I2CINT_RECEIVE_EV = BIT(15),
|
|
};
|
|
|
|
enum {
|
|
I2CMB_READ = 0 << 10,
|
|
I2CMB_WRITE = 1 << 10,
|
|
I2CMB_1BYTE = 0 << 11,
|
|
I2CMB_2BYTE = 1 << 11,
|
|
I2CMB_DONT_HOLD_BUS = 0 << 13,
|
|
I2CMB_HOLD_BUS = 1 << 13,
|
|
I2CMB_NATIVE = 2 << 14,
|
|
};
|
|
|
|
enum {
|
|
I2COP_WRITE = 0,
|
|
I2COP_READ = 1,
|
|
};
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
static int wait_for_int(struct udevice *dev, int read)
|
|
#else
|
|
static int wait_for_int(bool read)
|
|
#endif
|
|
{
|
|
u16 val;
|
|
uint ctr = 0;
|
|
#ifdef CONFIG_DM_I2C
|
|
struct ihs_i2c_priv *priv = dev_get_priv(dev);
|
|
struct udevice *fpga;
|
|
|
|
gdsys_soc_get_fpga(dev, &fpga);
|
|
#endif
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
fpgamap_read(fpga, priv->addr + REG_INTERRUPT_STATUS, &val,
|
|
FPGAMAP_SIZE_16);
|
|
#else
|
|
I2C_GET_REG(interrupt_status, &val);
|
|
#endif
|
|
/* Wait until error or receive/transmit interrupt was raised */
|
|
while (!(val & (I2CINT_ERROR_EV
|
|
| (read ? I2CINT_RECEIVE_EV : I2CINT_TRANSMIT_EV)))) {
|
|
udelay(10);
|
|
if (ctr++ > 5000)
|
|
return 1;
|
|
#ifdef CONFIG_DM_I2C
|
|
fpgamap_read(fpga, priv->addr + REG_INTERRUPT_STATUS, &val,
|
|
FPGAMAP_SIZE_16);
|
|
#else
|
|
I2C_GET_REG(interrupt_status, &val);
|
|
#endif
|
|
}
|
|
|
|
return (val & I2CINT_ERROR_EV) ? 1 : 0;
|
|
}
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
static int ihs_i2c_transfer(struct udevice *dev, uchar chip,
|
|
uchar *buffer, int len, int read, bool is_last)
|
|
#else
|
|
static int ihs_i2c_transfer(uchar chip, uchar *buffer, int len, bool read,
|
|
bool is_last)
|
|
#endif
|
|
{
|
|
u16 val;
|
|
u16 data;
|
|
#ifdef CONFIG_DM_I2C
|
|
struct ihs_i2c_priv *priv = dev_get_priv(dev);
|
|
struct udevice *fpga;
|
|
|
|
gdsys_soc_get_fpga(dev, &fpga);
|
|
#endif
|
|
|
|
/* Clear interrupt status */
|
|
data = I2CINT_ERROR_EV | I2CINT_RECEIVE_EV | I2CINT_TRANSMIT_EV;
|
|
#ifdef CONFIG_DM_I2C
|
|
fpgamap_write(fpga, priv->addr + REG_INTERRUPT_STATUS, &data,
|
|
FPGAMAP_SIZE_16);
|
|
fpgamap_read(fpga, priv->addr + REG_INTERRUPT_STATUS, &val,
|
|
FPGAMAP_SIZE_16);
|
|
#else
|
|
I2C_SET_REG(interrupt_status, data);
|
|
I2C_GET_REG(interrupt_status, &val);
|
|
#endif
|
|
|
|
/* If we want to write and have data, write the bytes to the mailbox */
|
|
if (!read && len) {
|
|
val = buffer[0];
|
|
|
|
if (len > 1)
|
|
val |= buffer[1] << 8;
|
|
#ifdef CONFIG_DM_I2C
|
|
fpgamap_write(fpga, priv->addr + REG_WRITE_MAILBOX_EXT, &val,
|
|
FPGAMAP_SIZE_16);
|
|
#else
|
|
I2C_SET_REG(write_mailbox_ext, val);
|
|
#endif
|
|
}
|
|
|
|
data = I2CMB_NATIVE
|
|
| (read ? 0 : I2CMB_WRITE)
|
|
| (chip << 1)
|
|
| ((len > 1) ? I2CMB_2BYTE : 0)
|
|
| (is_last ? 0 : I2CMB_HOLD_BUS);
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
fpgamap_write(fpga, priv->addr + REG_WRITE_MAILBOX, &data,
|
|
FPGAMAP_SIZE_16);
|
|
#else
|
|
I2C_SET_REG(write_mailbox, data);
|
|
#endif
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
if (wait_for_int(dev, read))
|
|
#else
|
|
if (wait_for_int(read))
|
|
#endif
|
|
return 1;
|
|
|
|
/* If we want to read, get the bytes from the mailbox */
|
|
if (read) {
|
|
#ifdef CONFIG_DM_I2C
|
|
fpgamap_read(fpga, priv->addr + REG_READ_MAILBOX_EXT, &val,
|
|
FPGAMAP_SIZE_16);
|
|
#else
|
|
I2C_GET_REG(read_mailbox_ext, &val);
|
|
#endif
|
|
buffer[0] = val & 0xff;
|
|
if (len > 1)
|
|
buffer[1] = val >> 8;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
static int ihs_i2c_send_buffer(struct udevice *dev, uchar chip, u8 *data, int len, bool hold_bus, int read)
|
|
#else
|
|
static int ihs_i2c_send_buffer(uchar chip, u8 *data, int len, bool hold_bus,
|
|
int read)
|
|
#endif
|
|
{
|
|
while (len) {
|
|
int transfer = min(len, 2);
|
|
bool is_last = len <= transfer;
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
if (ihs_i2c_transfer(dev, chip, data, transfer, read,
|
|
hold_bus ? false : is_last))
|
|
return 1;
|
|
#else
|
|
if (ihs_i2c_transfer(chip, data, transfer, read,
|
|
hold_bus ? false : is_last))
|
|
return 1;
|
|
#endif
|
|
|
|
data += transfer;
|
|
len -= transfer;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
static int ihs_i2c_address(struct udevice *dev, uchar chip, u8 *addr, int alen,
|
|
bool hold_bus)
|
|
#else
|
|
static int ihs_i2c_address(uchar chip, u8 *addr, int alen, bool hold_bus)
|
|
#endif
|
|
{
|
|
#ifdef CONFIG_DM_I2C
|
|
return ihs_i2c_send_buffer(dev, chip, addr, alen, hold_bus, I2COP_WRITE);
|
|
#else
|
|
return ihs_i2c_send_buffer(chip, addr, alen, hold_bus, I2COP_WRITE);
|
|
#endif
|
|
}
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
static int ihs_i2c_access(struct udevice *dev, uchar chip, u8 *addr,
|
|
int alen, uchar *buffer, int len, int read)
|
|
#else
|
|
static int ihs_i2c_access(struct i2c_adapter *adap, uchar chip, u8 *addr,
|
|
int alen, uchar *buffer, int len, int read)
|
|
#endif
|
|
{
|
|
/* Don't hold the bus if length of data to send/receive is zero */
|
|
#ifdef CONFIG_DM_I2C
|
|
if (len <= 0 || ihs_i2c_address(dev, chip, addr, alen, len))
|
|
return 1;
|
|
#else
|
|
if (len <= 0 || ihs_i2c_address(chip, addr, alen, len))
|
|
return 1;
|
|
#endif
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
return ihs_i2c_send_buffer(dev, chip, buffer, len, false, read);
|
|
#else
|
|
return ihs_i2c_send_buffer(chip, buffer, len, false, read);
|
|
#endif
|
|
}
|
|
|
|
#ifdef CONFIG_DM_I2C
|
|
|
|
int ihs_i2c_probe(struct udevice *bus)
|
|
{
|
|
struct ihs_i2c_priv *priv = dev_get_priv(bus);
|
|
int addr;
|
|
|
|
addr = dev_read_u32_default(bus, "reg", -1);
|
|
|
|
priv->addr = addr;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ihs_i2c_set_bus_speed(struct udevice *bus, uint speed)
|
|
{
|
|
struct ihs_i2c_priv *priv = dev_get_priv(bus);
|
|
|
|
if (speed != priv->speed && priv->speed != 0)
|
|
return 1;
|
|
|
|
priv->speed = speed;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ihs_i2c_xfer(struct udevice *bus, struct i2c_msg *msg, int nmsgs)
|
|
{
|
|
struct i2c_msg *dmsg, *omsg, dummy;
|
|
|
|
memset(&dummy, 0, sizeof(struct i2c_msg));
|
|
|
|
/* We expect either two messages (one with an offset and one with the
|
|
* actucal data) or one message (just data)
|
|
*/
|
|
if (nmsgs > 2 || nmsgs == 0) {
|
|
debug("%s: Only one or two messages are supported.", __func__);
|
|
return -1;
|
|
}
|
|
|
|
omsg = nmsgs == 1 ? &dummy : msg;
|
|
dmsg = nmsgs == 1 ? msg : msg + 1;
|
|
|
|
if (dmsg->flags & I2C_M_RD)
|
|
return ihs_i2c_access(bus, dmsg->addr, omsg->buf,
|
|
omsg->len, dmsg->buf, dmsg->len,
|
|
I2COP_READ);
|
|
else
|
|
return ihs_i2c_access(bus, dmsg->addr, omsg->buf,
|
|
omsg->len, dmsg->buf, dmsg->len,
|
|
I2COP_WRITE);
|
|
}
|
|
|
|
static int ihs_i2c_probe_chip(struct udevice *bus, u32 chip_addr,
|
|
u32 chip_flags)
|
|
{
|
|
uchar buffer[2];
|
|
|
|
if (ihs_i2c_transfer(bus, chip_addr, buffer, 0, I2COP_READ, true))
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct dm_i2c_ops ihs_i2c_ops = {
|
|
.xfer = ihs_i2c_xfer,
|
|
.probe_chip = ihs_i2c_probe_chip,
|
|
.set_bus_speed = ihs_i2c_set_bus_speed,
|
|
};
|
|
|
|
static const struct udevice_id ihs_i2c_ids[] = {
|
|
{ .compatible = "gdsys,ihs_i2cmaster", },
|
|
{ /* sentinel */ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(i2c_ihs) = {
|
|
.name = "i2c_ihs",
|
|
.id = UCLASS_I2C,
|
|
.of_match = ihs_i2c_ids,
|
|
.probe = ihs_i2c_probe,
|
|
.priv_auto_alloc_size = sizeof(struct ihs_i2c_priv),
|
|
.ops = &ihs_i2c_ops,
|
|
};
|
|
|
|
#else /* CONFIG_DM_I2C */
|
|
|
|
static void ihs_i2c_init(struct i2c_adapter *adap, int speed, int slaveaddr)
|
|
{
|
|
#ifdef CONFIG_SYS_I2C_INIT_BOARD
|
|
/*
|
|
* Call board specific i2c bus reset routine before accessing the
|
|
* environment, which might be in a chip on that bus. For details
|
|
* about this problem see doc/I2C_Edge_Conditions.
|
|
*/
|
|
i2c_init_board();
|
|
#endif
|
|
}
|
|
|
|
static int ihs_i2c_probe(struct i2c_adapter *adap, uchar chip)
|
|
{
|
|
uchar buffer[2];
|
|
|
|
if (ihs_i2c_transfer(chip, buffer, 0, I2COP_READ, true))
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ihs_i2c_read(struct i2c_adapter *adap, uchar chip, uint addr,
|
|
int alen, uchar *buffer, int len)
|
|
{
|
|
u8 addr_bytes[4];
|
|
|
|
put_unaligned_le32(addr, addr_bytes);
|
|
|
|
return ihs_i2c_access(adap, chip, addr_bytes, alen, buffer, len,
|
|
I2COP_READ);
|
|
}
|
|
|
|
static int ihs_i2c_write(struct i2c_adapter *adap, uchar chip, uint addr,
|
|
int alen, uchar *buffer, int len)
|
|
{
|
|
u8 addr_bytes[4];
|
|
|
|
put_unaligned_le32(addr, addr_bytes);
|
|
|
|
return ihs_i2c_access(adap, chip, addr_bytes, alen, buffer, len,
|
|
I2COP_WRITE);
|
|
}
|
|
|
|
static unsigned int ihs_i2c_set_bus_speed(struct i2c_adapter *adap,
|
|
unsigned int speed)
|
|
{
|
|
if (speed != adap->speed)
|
|
return 1;
|
|
return speed;
|
|
}
|
|
|
|
/*
|
|
* Register IHS i2c adapters
|
|
*/
|
|
#ifdef CONFIG_SYS_I2C_IHS_CH0
|
|
U_BOOT_I2C_ADAP_COMPLETE(ihs0, ihs_i2c_init, ihs_i2c_probe,
|
|
ihs_i2c_read, ihs_i2c_write,
|
|
ihs_i2c_set_bus_speed,
|
|
CONFIG_SYS_I2C_IHS_SPEED_0,
|
|
CONFIG_SYS_I2C_IHS_SLAVE_0, 0)
|
|
#ifdef CONFIG_SYS_I2C_IHS_DUAL
|
|
U_BOOT_I2C_ADAP_COMPLETE(ihs0_1, ihs_i2c_init, ihs_i2c_probe,
|
|
ihs_i2c_read, ihs_i2c_write,
|
|
ihs_i2c_set_bus_speed,
|
|
CONFIG_SYS_I2C_IHS_SPEED_0_1,
|
|
CONFIG_SYS_I2C_IHS_SLAVE_0_1, 16)
|
|
#endif
|
|
#endif
|
|
#ifdef CONFIG_SYS_I2C_IHS_CH1
|
|
U_BOOT_I2C_ADAP_COMPLETE(ihs1, ihs_i2c_init, ihs_i2c_probe,
|
|
ihs_i2c_read, ihs_i2c_write,
|
|
ihs_i2c_set_bus_speed,
|
|
CONFIG_SYS_I2C_IHS_SPEED_1,
|
|
CONFIG_SYS_I2C_IHS_SLAVE_1, 1)
|
|
#ifdef CONFIG_SYS_I2C_IHS_DUAL
|
|
U_BOOT_I2C_ADAP_COMPLETE(ihs1_1, ihs_i2c_init, ihs_i2c_probe,
|
|
ihs_i2c_read, ihs_i2c_write,
|
|
ihs_i2c_set_bus_speed,
|
|
CONFIG_SYS_I2C_IHS_SPEED_1_1,
|
|
CONFIG_SYS_I2C_IHS_SLAVE_1_1, 17)
|
|
#endif
|
|
#endif
|
|
#ifdef CONFIG_SYS_I2C_IHS_CH2
|
|
U_BOOT_I2C_ADAP_COMPLETE(ihs2, ihs_i2c_init, ihs_i2c_probe,
|
|
ihs_i2c_read, ihs_i2c_write,
|
|
ihs_i2c_set_bus_speed,
|
|
CONFIG_SYS_I2C_IHS_SPEED_2,
|
|
CONFIG_SYS_I2C_IHS_SLAVE_2, 2)
|
|
#ifdef CONFIG_SYS_I2C_IHS_DUAL
|
|
U_BOOT_I2C_ADAP_COMPLETE(ihs2_1, ihs_i2c_init, ihs_i2c_probe,
|
|
ihs_i2c_read, ihs_i2c_write,
|
|
ihs_i2c_set_bus_speed,
|
|
CONFIG_SYS_I2C_IHS_SPEED_2_1,
|
|
CONFIG_SYS_I2C_IHS_SLAVE_2_1, 18)
|
|
#endif
|
|
#endif
|
|
#ifdef CONFIG_SYS_I2C_IHS_CH3
|
|
U_BOOT_I2C_ADAP_COMPLETE(ihs3, ihs_i2c_init, ihs_i2c_probe,
|
|
ihs_i2c_read, ihs_i2c_write,
|
|
ihs_i2c_set_bus_speed,
|
|
CONFIG_SYS_I2C_IHS_SPEED_3,
|
|
CONFIG_SYS_I2C_IHS_SLAVE_3, 3)
|
|
#ifdef CONFIG_SYS_I2C_IHS_DUAL
|
|
U_BOOT_I2C_ADAP_COMPLETE(ihs3_1, ihs_i2c_init, ihs_i2c_probe,
|
|
ihs_i2c_read, ihs_i2c_write,
|
|
ihs_i2c_set_bus_speed,
|
|
CONFIG_SYS_I2C_IHS_SPEED_3_1,
|
|
CONFIG_SYS_I2C_IHS_SLAVE_3_1, 19)
|
|
#endif
|
|
#endif
|
|
#endif /* CONFIG_DM_I2C */
|