@@ -131,11 +131,9 @@ static inline int is_itpm(struct acpi_device *dev)
* correct values in the other bits.' */
static int wait_startup(struct tpm_chip *chip, int l)
{
- struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
unsigned long stop = jiffies + chip->timeout_a;
do {
- if (ioread8(phy->iobase + TPM_ACCESS(l)) &
+ if (tpm_read8(chip, TPM_ACCESS(l)) &
TPM_ACCESS_VALID)
return 0;
msleep(TPM_TIMEOUT);
@@ -146,9 +144,8 @@ static int wait_startup(struct tpm_chip *chip, int l)
static int check_locality(struct tpm_chip *chip, int l)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
- if ((ioread8(phy->iobase + TPM_ACCESS(l)) &
+ if ((tpm_read8(chip, TPM_ACCESS(l)) &
(TPM_ACCESS_ACTIVE_LOCALITY | TPM_ACCESS_VALID)) ==
(TPM_ACCESS_ACTIVE_LOCALITY | TPM_ACCESS_VALID))
return priv->locality = l;
@@ -158,28 +155,23 @@ static int check_locality(struct tpm_chip *chip, int l)
static void release_locality(struct tpm_chip *chip, int l, int force)
{
- struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
-
- if (force || (ioread8(phy->iobase + TPM_ACCESS(l)) &
+ if (force || (tpm_read8(chip, TPM_ACCESS(l)) &
(TPM_ACCESS_REQUEST_PENDING | TPM_ACCESS_VALID)) ==
(TPM_ACCESS_REQUEST_PENDING | TPM_ACCESS_VALID))
- iowrite8(TPM_ACCESS_ACTIVE_LOCALITY,
- phy->iobase + TPM_ACCESS(l));
+ tpm_write8(chip, TPM_ACCESS(l), TPM_ACCESS_ACTIVE_LOCALITY);
+
}
static int request_locality(struct tpm_chip *chip, int l)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
unsigned long stop, timeout;
long rc;
if (check_locality(chip, l) >= 0)
return l;
- iowrite8(TPM_ACCESS_REQUEST_USE,
- phy->iobase + TPM_ACCESS(l));
+ tpm_write8(chip, TPM_ACCESS(l), TPM_ACCESS_REQUEST_USE);
stop = jiffies + chip->timeout_a;
@@ -213,26 +205,21 @@ again:
static u8 tpm_tis_status(struct tpm_chip *chip)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
- return ioread8(phy->iobase +
- TPM_STS(priv->locality));
+ return tpm_read8(chip, TPM_STS(priv->locality));
}
static void tpm_tis_ready(struct tpm_chip *chip)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
/* this causes the current command to be aborted */
- iowrite8(TPM_STS_COMMAND_READY,
- phy->iobase + TPM_STS(priv->locality));
+ tpm_write8(chip, TPM_STS(priv->locality), TPM_STS_COMMAND_READY);
}
static int get_burstcount(struct tpm_chip *chip)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
unsigned long stop;
int burstcnt;
@@ -240,11 +227,8 @@ static int get_burstcount(struct tpm_chip *chip)
/* which timeout value, spec has 2 answers (c & d) */
stop = jiffies + chip->timeout_d;
do {
- burstcnt = ioread8(phy->iobase +
- TPM_STS(priv->locality) + 1);
- burstcnt += ioread8(phy->iobase +
- TPM_STS(priv->locality) +
- 2) << 8;
+ burstcnt = tpm_read8(chip, TPM_STS(priv->locality) + 1);
+ burstcnt += tpm_read8(chip, TPM_STS(priv->locality) + 2) << 8;
if (burstcnt)
return burstcnt;
msleep(TPM_TIMEOUT);
@@ -255,18 +239,16 @@ static int get_burstcount(struct tpm_chip *chip)
static int recv_data(struct tpm_chip *chip, u8 *buf, size_t count)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
int size = 0, burstcnt;
while (size < count &&
wait_for_tpm_stat(chip,
TPM_STS_DATA_AVAIL | TPM_STS_VALID,
chip->timeout_c,
- &priv->read_queue, true)
- == 0) {
- burstcnt = get_burstcount(chip);
- for (; burstcnt > 0 && size < count; burstcnt--)
- buf[size++] = ioread8(phy->iobase +
- TPM_DATA_FIFO(priv->locality));
+ &priv->read_queue, true) == 0) {
+ burstcnt = min_t(int, get_burstcount(chip), count - size);
+ tpm_read_bytes(chip, TPM_DATA_FIFO(priv->locality),
+ burstcnt, buf + size);
+ size += burstcnt;
}
return size;
}
@@ -330,7 +312,6 @@ MODULE_PARM_DESC(itpm, "Force iTPM workarounds (found on some Lenovo laptops)");
static int tpm_tis_send_data(struct tpm_chip *chip, u8 *buf, size_t len)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
int rc, status, burstcnt;
size_t count = 0;
@@ -349,12 +330,10 @@ static int tpm_tis_send_data(struct tpm_chip *chip, u8 *buf, size_t len)
}
while (count < len - 1) {
- burstcnt = get_burstcount(chip);
- for (; burstcnt > 0 && count < len - 1; burstcnt--) {
- iowrite8(buf[count], phy->iobase +
- TPM_DATA_FIFO(priv->locality));
- count++;
- }
+ burstcnt = min_t(int, get_burstcount(chip), len - count - 1);
+ tpm_write_bytes(chip, TPM_DATA_FIFO(priv->locality),
+ burstcnt, buf + count);
+ count += burstcnt;
wait_for_tpm_stat(chip, TPM_STS_VALID, chip->timeout_c,
&priv->int_queue, false);
@@ -366,8 +345,8 @@ static int tpm_tis_send_data(struct tpm_chip *chip, u8 *buf, size_t len)
}
/* write last byte */
- iowrite8(buf[count],
- phy->iobase + TPM_DATA_FIFO(priv->locality));
+ tpm_write8(chip, TPM_DATA_FIFO(priv->locality), buf[count]);
+
wait_for_tpm_stat(chip, TPM_STS_VALID, chip->timeout_c,
&priv->int_queue, false);
status = tpm_tis_status(chip);
@@ -387,15 +366,12 @@ out_err:
static void disable_interrupts(struct tpm_chip *chip)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
u32 intmask;
- intmask =
- ioread32(phy->iobase +
- TPM_INT_ENABLE(priv->locality));
+ intmask = tpm_read32(chip, TPM_INT_ENABLE(priv->locality));
intmask &= ~TPM_GLOBAL_INT_ENABLE;
- iowrite32(intmask,
- phy->iobase + TPM_INT_ENABLE(priv->locality));
+ tpm_write32(chip, TPM_INT_ENABLE(priv->locality), intmask);
+
devm_free_irq(&chip->dev, priv->irq, chip);
priv->irq = 0;
chip->flags &= ~TPM_CHIP_FLAG_IRQ;
@@ -409,7 +385,6 @@ static void disable_interrupts(struct tpm_chip *chip)
static int tpm_tis_send_main(struct tpm_chip *chip, u8 *buf, size_t len)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
int rc;
u32 ordinal;
unsigned long dur;
@@ -419,8 +394,7 @@ static int tpm_tis_send_main(struct tpm_chip *chip, u8 *buf, size_t len)
return rc;
/* go and do it */
- iowrite8(TPM_STS_GO,
- phy->iobase + TPM_STS(priv->locality));
+ tpm_write8(chip, TPM_STS(priv->locality), TPM_STS_GO);
if (chip->flags & TPM_CHIP_FLAG_IRQ) {
ordinal = be32_to_cpu(*((__be32 *) (buf + 6)));
@@ -481,12 +455,10 @@ static const struct tis_vendor_timeout_override vendor_timeout_overrides[] = {
static bool tpm_tis_update_timeouts(struct tpm_chip *chip,
unsigned long *timeout_cap)
{
- struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
int i;
u32 did_vid;
- did_vid = ioread32(phy->iobase + TPM_DID_VID(0));
+ did_vid = tpm_read32(chip, TPM_DID_VID(0));
for (i = 0; i != ARRAY_SIZE(vendor_timeout_overrides); i++) {
if (vendor_timeout_overrides[i].did_vid != did_vid)
@@ -507,7 +479,6 @@ static bool tpm_tis_update_timeouts(struct tpm_chip *chip,
static int probe_itpm(struct tpm_chip *chip)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
int rc = 0;
u8 cmd_getticks[] = {
0x00, 0xc1, 0x00, 0x00, 0x00, 0x0a,
@@ -515,7 +486,7 @@ static int probe_itpm(struct tpm_chip *chip)
};
size_t len = sizeof(cmd_getticks);
bool rem_itpm = itpm;
- u16 vendor = ioread16(phy->iobase + TPM_DID_VID(0));
+ u16 vendor = tpm_read16(chip, TPM_DID_VID(0));
/* probe only iTPMS */
if (vendor != TPM_VID_INTEL)
@@ -573,16 +544,66 @@ static const struct tpm_class_ops tpm_tis = {
.req_canceled = tpm_tis_req_canceled,
};
+static void tpm_mem_read_bytes(struct tpm_chip *chip, u32 addr, u16 len,
+ u8 *result)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+ struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
+
+ while (len--)
+ *result++ = ioread8(phy->iobase + addr);
+}
+
+static void tpm_mem_write_bytes(struct tpm_chip *chip, u32 addr, u16 len,
+ u8 *value)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+ struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
+
+ while (len--)
+ iowrite8(*value++, phy->iobase + addr);
+}
+
+static u16 tpm_mem_read16(struct tpm_chip *chip, u32 addr)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+ struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
+
+ return ioread16(phy->iobase + addr);
+}
+
+static u32 tpm_mem_read32(struct tpm_chip *chip, u32 addr)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+ struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
+
+ return ioread32(phy->iobase + addr);
+}
+
+static void tpm_mem_write32(struct tpm_chip *chip, u32 addr, u32 value)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+ struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
+
+ iowrite32(value, phy->iobase + addr);
+}
+
+static const struct tpm_tis_phy_ops tpm_mem = {
+ .read_bytes = tpm_mem_read_bytes,
+ .write_bytes = tpm_mem_write_bytes,
+ .read16 = tpm_mem_read16,
+ .read32 = tpm_mem_read32,
+ .write32 = tpm_mem_write32,
+};
+
static irqreturn_t tis_int_handler(int dummy, void *dev_id)
{
struct tpm_chip *chip = dev_id;
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
u32 interrupt;
int i;
- interrupt = ioread32(phy->iobase +
- TPM_INT_STATUS(priv->locality));
+ interrupt = tpm_read32(chip, TPM_INT_STATUS(priv->locality));
if (interrupt == 0)
return IRQ_NONE;
@@ -600,10 +621,8 @@ static irqreturn_t tis_int_handler(int dummy, void *dev_id)
wake_up_interruptible(&priv->int_queue);
/* Clear interrupts handled with TPM_EOI */
- iowrite32(interrupt,
- phy->iobase +
- TPM_INT_STATUS(priv->locality));
- ioread32(phy->iobase + TPM_INT_STATUS(priv->locality));
+ tpm_write32(chip, TPM_INT_STATUS(priv->locality), interrupt);
+ tpm_read32(chip, TPM_INT_STATUS(priv->locality));
return IRQ_HANDLED;
}
@@ -615,7 +634,6 @@ static int tpm_tis_probe_irq_single(struct tpm_chip *chip, u32 intmask,
int flags, int irq)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
u8 original_int_vec;
if (devm_request_irq(&chip->dev, irq, tis_int_handler, flags,
@@ -626,19 +644,16 @@ static int tpm_tis_probe_irq_single(struct tpm_chip *chip, u32 intmask,
}
priv->irq = irq;
- original_int_vec = ioread8(phy->iobase +
- TPM_INT_VECTOR(priv->locality));
- iowrite8(irq,
- phy->iobase + TPM_INT_VECTOR(priv->locality));
+ original_int_vec = tpm_read8(chip, TPM_INT_VECTOR(priv->locality));
+ tpm_write8(chip, TPM_INT_VECTOR(priv->locality), irq);
/* Clear all existing */
- iowrite32(ioread32(phy->iobase +
- TPM_INT_STATUS(priv->locality)),
- phy->iobase + TPM_INT_STATUS(priv->locality));
+ tpm_write32(chip, TPM_INT_STATUS(priv->locality),
+ tpm_read32(chip, TPM_INT_STATUS(priv->locality)));
/* Turn on */
- iowrite32(intmask | TPM_GLOBAL_INT_ENABLE,
- phy->iobase + TPM_INT_ENABLE(priv->locality));
+ tpm_write32(chip, TPM_INT_ENABLE(priv->locality),
+ intmask | TPM_GLOBAL_INT_ENABLE);
priv->irq_tested = false;
@@ -654,8 +669,9 @@ static int tpm_tis_probe_irq_single(struct tpm_chip *chip, u32 intmask,
* will call disable_irq which undoes all of the above.
*/
if (!(chip->flags & TPM_CHIP_FLAG_IRQ)) {
- iowrite8(original_int_vec,
- phy->iobase + TPM_INT_VECTOR(priv->locality));
+ tpm_write8(chip, TPM_INT_VECTOR(priv->locality),
+ original_int_vec);
+
return 1;
}
@@ -669,12 +685,10 @@ static int tpm_tis_probe_irq_single(struct tpm_chip *chip, u32 intmask,
static void tpm_tis_probe_irq(struct tpm_chip *chip, u32 intmask)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
u8 original_int_vec;
int i;
- original_int_vec = ioread8(phy->iobase +
- TPM_INT_VECTOR(priv->locality));
+ original_int_vec = tpm_read8(chip, TPM_INT_VECTOR(priv->locality));
if (!original_int_vec) {
if (IS_ENABLED(CONFIG_X86))
@@ -694,10 +708,9 @@ MODULE_PARM_DESC(interrupts, "Enable interrupts");
static void tpm_tis_remove(struct tpm_chip *chip)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
- void __iomem *reg = phy->iobase + TPM_INT_ENABLE(priv->locality);
+ u32 reg = TPM_INT_ENABLE(priv->locality);
- iowrite32(~TPM_GLOBAL_INT_ENABLE & ioread32(reg), reg);
+ tpm_write32(chip, reg, ~TPM_GLOBAL_INT_ENABLE & tpm_read32(chip, reg));
release_locality(chip, priv->locality, 1);
}
@@ -725,6 +738,8 @@ static int tpm_tis_init(struct device *dev, struct tpm_info *tpm_info,
if (IS_ERR(phy->iobase))
return PTR_ERR(phy->iobase);
+ phy->priv.phy_ops = &tpm_mem;
+
/* Maximum timeouts */
chip->timeout_a = TIS_TIMEOUT_A_MAX;
chip->timeout_b = TIS_TIMEOUT_B_MAX;
@@ -739,13 +754,11 @@ static int tpm_tis_init(struct device *dev, struct tpm_info *tpm_info,
}
/* Take control of the TPM's interrupt hardware and shut it off */
- intmask = ioread32(phy->iobase +
- TPM_INT_ENABLE(phy->priv.locality));
+ intmask = tpm_read32(chip, TPM_INT_ENABLE(phy->priv.locality));
intmask |= TPM_INTF_CMD_READY_INT | TPM_INTF_LOCALITY_CHANGE_INT |
TPM_INTF_DATA_AVAIL_INT | TPM_INTF_STS_VALID_INT;
intmask &= ~TPM_GLOBAL_INT_ENABLE;
- iowrite32(intmask,
- phy->iobase + TPM_INT_ENABLE(phy->priv.locality));
+ tpm_write32(chip, TPM_INT_ENABLE(phy->priv.locality), intmask);
if (request_locality(chip, 0) != 0) {
rc = -ENODEV;
@@ -756,12 +769,12 @@ static int tpm_tis_init(struct device *dev, struct tpm_info *tpm_info,
if (rc)
goto out_err;
- vendor = ioread32(phy->iobase + TPM_DID_VID(0));
+ vendor = tpm_read32(chip, TPM_DID_VID(0));
phy->priv.manufacturer_id = vendor;
dev_info(dev, "%s TPM (device-id 0x%X, rev-id %d)\n",
(chip->flags & TPM_CHIP_FLAG_TPM2) ? "2.0" : "1.2",
- vendor >> 16, ioread8(phy->iobase + TPM_RID(0)));
+ vendor >> 16, tpm_read8(chip, TPM_RID(0)));
if (!itpm) {
probe = probe_itpm(chip);
@@ -777,9 +790,7 @@ static int tpm_tis_init(struct device *dev, struct tpm_info *tpm_info,
/* Figure out the capabilities */
- intfcaps =
- ioread32(phy->iobase +
- TPM_INTF_CAPS(phy->priv.locality));
+ intfcaps = tpm_read32(chip, TPM_INTF_CAPS(phy->priv.locality));
dev_dbg(dev, "TPM interface capabilities (0x%x):\n",
intfcaps);
if (intfcaps & TPM_INTF_BURST_COUNT_STATIC)
@@ -858,23 +869,19 @@ out_err:
static void tpm_tis_reenable_interrupts(struct tpm_chip *chip)
{
struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
- struct tpm_tis_lpc_phy *phy = to_tpm_tis_lpc_phy(priv);
u32 intmask;
/* reenable interrupts that device may have lost or
BIOS/firmware may have disabled */
- iowrite8(priv->irq, phy->iobase +
- TPM_INT_VECTOR(priv->locality));
+ tpm_write8(chip, TPM_INT_VECTOR(priv->locality), priv->irq);
- intmask =
- ioread32(phy->iobase + TPM_INT_ENABLE(priv->locality));
+ intmask = tpm_read32(chip, TPM_INT_ENABLE(priv->locality));
intmask |= TPM_INTF_CMD_READY_INT
| TPM_INTF_LOCALITY_CHANGE_INT | TPM_INTF_DATA_AVAIL_INT
| TPM_INTF_STS_VALID_INT | TPM_GLOBAL_INT_ENABLE;
- iowrite32(intmask,
- phy->iobase + TPM_INT_ENABLE(priv->locality));
+ tpm_write32(chip, TPM_INT_ENABLE(priv->locality), intmask);
}
static int tpm_tis_resume(struct device *dev)
@@ -25,6 +25,16 @@
#include "tpm.h"
+struct tpm_tis_phy_ops {
+ void (*read_bytes)(struct tpm_chip *chip, u32 addr, u16 len,
+ u8 *result);
+ void (*write_bytes)(struct tpm_chip *chip, u32 addr, u16 len,
+ u8 *value);
+ u16 (*read16)(struct tpm_chip *chip, u32 addr);
+ u32 (*read32)(struct tpm_chip *chip, u32 addr);
+ void (*write32)(struct tpm_chip *chip, u32 addr, u32 src);
+};
+
struct tpm_tis_data {
u16 manufacturer_id;
int locality;
@@ -32,6 +42,60 @@ struct tpm_tis_data {
bool irq_tested;
wait_queue_head_t int_queue;
wait_queue_head_t read_queue;
+ const struct tpm_tis_phy_ops *phy_ops;
};
+static inline void tpm_read_bytes(struct tpm_chip *chip, u32 addr, u16 len,
+ u8 *result)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+
+ priv->phy_ops->read_bytes(chip, addr, len, result);
+}
+
+static inline u8 tpm_read8(struct tpm_chip *chip, u32 addr)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+ u8 result;
+
+ priv->phy_ops->read_bytes(chip, addr, 1, &result);
+ return result;
+}
+
+static inline u16 tpm_read16(struct tpm_chip *chip, u32 addr)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+
+ return priv->phy_ops->read16(chip, addr);
+}
+
+static inline u32 tpm_read32(struct tpm_chip *chip, u32 addr)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+
+ return priv->phy_ops->read32(chip, addr);
+}
+
+static inline void tpm_write_bytes(struct tpm_chip *chip, u32 addr, u16 len,
+ u8 *value)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+
+ priv->phy_ops->write_bytes(chip, addr, len, value);
+}
+
+static inline void tpm_write8(struct tpm_chip *chip, u32 addr, u8 value)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+
+ priv->phy_ops->write_bytes(chip, addr, 1, &value);
+}
+
+static inline void tpm_write32(struct tpm_chip *chip, u32 addr, u32 value)
+{
+ struct tpm_tis_data *priv = dev_get_drvdata(&chip->dev);
+
+ priv->phy_ops->write32(chip, addr, value);
+}
+
#endif