#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: spdmem_i2c.c,v 1.26 2022/03/30 00:06:50 pgoyette Exp $");
#include <sys/param.h>
#include <sys/device.h>
#include <sys/endian.h>
#include <sys/module.h>
#include <sys/sysctl.h>
#include <machine/bswap.h>
#include <dev/i2c/i2cvar.h>
#include <dev/ic/spdmemreg.h>
#include <dev/ic/spdmemvar.h>
#define SPDMEM_I2C_ADDRMASK 0xfff8
#define SPDMEM_I2C_ADDR 0x50
#define SPDCTL_I2C_ADDR 0x30
#define SPDCTL_SWP0 (SPDCTL_I2C_ADDR + 1)
#define SPDCTL_SWP1 (SPDCTL_I2C_ADDR + 4)
#define SPDCTL_SWP2 (SPDCTL_I2C_ADDR + 5)
#define SPDCTL_SWP3 (SPDCTL_I2C_ADDR + 0)
#define SPDCTL_CWP (SPDCTL_I2C_ADDR + 3)
#define SPDCTL_RPS0 (SPDCTL_I2C_ADDR + 1)
#define SPDCTL_RPS1 (SPDCTL_I2C_ADDR + 4)
#define SPDCTL_RPS2 (SPDCTL_I2C_ADDR + 5)
#define SPDCTL_RPS3 (SPDCTL_I2C_ADDR + 0)
#define SPDCTL_SPA0 (SPDCTL_I2C_ADDR + 6)
#define SPDCTL_SPA1 (SPDCTL_I2C_ADDR + 7)
#define SPDCTL_RPA (SPDCTL_I2C_ADDR + 6)
struct spdmem_i2c_softc {
struct spdmem_softc sc_base;
i2c_tag_t sc_tag;
i2c_addr_t sc_addr;
i2c_addr_t sc_page0;
i2c_addr_t sc_page1;
};
static int spdmem_reset_page(struct spdmem_i2c_softc *);
static int spdmem_i2c_match(device_t, cfdata_t, void *);
static void spdmem_i2c_attach(device_t, device_t, void *);
static int spdmem_i2c_detach(device_t, int);
CFATTACH_DECL_NEW(spdmem_iic, sizeof(struct spdmem_i2c_softc),
spdmem_i2c_match, spdmem_i2c_attach, spdmem_i2c_detach, NULL);
static int spdmem_i2c_read(struct spdmem_softc *, uint16_t, uint8_t *);
static int
spdmem_reset_page(struct spdmem_i2c_softc *sc)
{
uint8_t reg, byte0, byte2;
static uint8_t dummy = 0;
int rv;
reg = 0;
rv = iic_acquire_bus(sc->sc_tag, 0);
if (rv)
return rv;
rv = iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, sc->sc_addr, ®, 1,
&byte0, 1, 0);
if (rv != 0)
goto error;
reg = 2;
rv = iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, sc->sc_addr, ®, 1,
&byte2, 1, 0);
if (rv != 0)
goto error;
if ((byte0 == 0) || (byte2 == 0)) {
rv = iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, sc->sc_page0,
®, 1, &dummy, 1, 0);
if (rv != 0) {
rv = iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP,
sc->sc_page0, ®, 1, &dummy, 1, 0);
if (rv == 0) {
aprint_debug("Page 1 was selected. Page 0 is "
"selected now.\n");
} else {
aprint_debug("Failed to select page 0. This "
"device isn't SPD ROM\n");
}
} else {
rv = -1;
}
}
error:
iic_release_bus(sc->sc_tag, 0);
return rv;
}
static const struct device_compatible_entry compat_data[] = {
{ .compat = "atmel,spd" },
{ .compat = "i2c-at34c02" },
DEVICE_COMPAT_EOL
};
static int
spdmem_i2c_match(device_t parent, cfdata_t match, void *aux)
{
struct i2c_attach_args *ia = aux;
struct spdmem_i2c_softc sc;
int match_result;
if (iic_use_direct_match(ia, match, compat_data, &match_result))
return match_result;
if (ia->ia_name) {
if (strcmp(ia->ia_name, "dimm-spd") &&
strcmp(ia->ia_name, "dimm"))
return 0;
}
if (ia->ia_name == NULL) {
if ((ia->ia_addr & SPDMEM_I2C_ADDRMASK) != SPDMEM_I2C_ADDR)
return 0;
}
sc.sc_tag = ia->ia_tag;
sc.sc_addr = ia->ia_addr;
sc.sc_page0 = SPDCTL_SPA0;
sc.sc_page1 = SPDCTL_SPA1;
sc.sc_base.sc_read = spdmem_i2c_read;
if (spdmem_reset_page(&sc) != 0)
return 0;
if (spdmem_common_probe(&sc.sc_base)) {
return ia->ia_name ? I2C_MATCH_DIRECT_SPECIFIC
: I2C_MATCH_ADDRESS_AND_PROBE;
}
return 0;
}
static void
spdmem_i2c_attach(device_t parent, device_t self, void *aux)
{
struct spdmem_i2c_softc *sc = device_private(self);
struct i2c_attach_args *ia = aux;
sc->sc_tag = ia->ia_tag;
sc->sc_addr = ia->ia_addr;
sc->sc_page0 = SPDCTL_SPA0;
sc->sc_page1 = SPDCTL_SPA1;
sc->sc_base.sc_read = spdmem_i2c_read;
if (!pmf_device_register(self, NULL, NULL))
aprint_error_dev(self, "couldn't establish power handler\n");
spdmem_common_attach(&sc->sc_base, self);
}
static int
spdmem_i2c_detach(device_t self, int flags)
{
struct spdmem_i2c_softc *sc = device_private(self);
pmf_device_deregister(self);
return spdmem_common_detach(&sc->sc_base, self);
}
static int
spdmem_i2c_read(struct spdmem_softc *softc, uint16_t addr, uint8_t *val)
{
uint8_t reg;
struct spdmem_i2c_softc *sc = (struct spdmem_i2c_softc *)softc;
static uint8_t dummy = 0;
int rv;
reg = addr & 0xff;
rv = iic_acquire_bus(sc->sc_tag, 0);
if (rv)
return rv;
if (addr & 0x100) {
rv = iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP, sc->sc_page1,
&dummy, 1, &dummy, 1, 0);
rv |= iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, sc->sc_addr,
®, 1, val, 1, 0);
rv |= iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP,
sc->sc_page0, &dummy, 1, &dummy, 1, 0);
} else {
rv = iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP, sc->sc_addr,
®, 1, val, 1, 0);
}
iic_release_bus(sc->sc_tag, 0);
return rv;
}
MODULE(MODULE_CLASS_DRIVER, spdmem, "iic");
#ifdef _MODULE
#include "ioconf.c"
#endif
static int
spdmem_modcmd(modcmd_t cmd, void *opaque)
{
int error = 0;
#ifdef _MODULE
static struct sysctllog *spdmem_sysctl_clog;
#endif
switch (cmd) {
case MODULE_CMD_INIT:
#ifdef _MODULE
error = config_init_component(cfdriver_ioconf_spdmem,
cfattach_ioconf_spdmem, cfdata_ioconf_spdmem);
#endif
return error;
case MODULE_CMD_FINI:
#ifdef _MODULE
error = config_fini_component(cfdriver_ioconf_spdmem,
cfattach_ioconf_spdmem, cfdata_ioconf_spdmem);
sysctl_teardown(&spdmem_sysctl_clog);
#endif
return error;
default:
return ENOTTY;
}
}