soc/qualcomm/ipq40xx: Use block mode for I2C
In FIFO mode, the I2C driver was not able to fetch more than 32 bytes of data from the TPM device. Switch to block mode to be able to read more data. BUG=chrome-os-partner:51096 TEST=TPM commands succeed BRANCH=None Change-Id: Ib52a1b03667f61a08ce048d38407a5b60abf660d Signed-off-by: Martin Roth <martinroth@chromium.org> Original-Commit-Id: fbcd40dc67d796d3e31675bd35321282667fe9fa Original-Change-Id: I765b76f9d7743f6d387470de594fb6eee99e08ca Original-Signed-off-by: Varadarajan Narayanan <varada@codeaurora.org> Original-Reviewed-on: https://chromium-review.googlesource.com/357960 Original-Commit-Ready: Kan Yan <kyan@google.com> Original-Tested-by: Kan Yan <kyan@google.com> Original-Reviewed-by: Kan Yan <kyan@google.com> Reviewed-on: https://review.coreboot.org/16051 Tested-by: build bot (Jenkins) Reviewed-by: Furquan Shaikh <furquan@google.com>
This commit is contained in:
parent
f41a9a6459
commit
e6a2ecf893
|
@ -44,7 +44,7 @@ static qup_config_t blsp1_qup0_config = {
|
|||
QUP_MINICORE_I2C_MASTER,
|
||||
100000,
|
||||
19050000,
|
||||
QUP_MODE_FIFO,
|
||||
QUP_MODE_BLOCK,
|
||||
0
|
||||
};
|
||||
|
||||
|
@ -52,7 +52,7 @@ static qup_config_t blsp1_qup1_config = {
|
|||
QUP_MINICORE_I2C_MASTER,
|
||||
100000,
|
||||
19050000,
|
||||
QUP_MODE_FIFO,
|
||||
QUP_MODE_BLOCK,
|
||||
0
|
||||
};
|
||||
|
||||
|
@ -60,7 +60,7 @@ static qup_config_t blsp1_qup2_config = {
|
|||
QUP_MINICORE_I2C_MASTER,
|
||||
100000,
|
||||
19050000,
|
||||
QUP_MODE_FIFO,
|
||||
QUP_MODE_BLOCK,
|
||||
0
|
||||
};
|
||||
|
||||
|
@ -68,7 +68,7 @@ static qup_config_t blsp1_qup3_config = {
|
|||
QUP_MINICORE_I2C_MASTER,
|
||||
100000,
|
||||
19050000,
|
||||
QUP_MODE_FIFO,
|
||||
QUP_MODE_BLOCK,
|
||||
0
|
||||
};
|
||||
|
||||
|
|
|
@ -198,10 +198,11 @@ static qup_return_t qup_i2c_write_fifo(blsp_qup_id_t id, qup_data_t *p_tx_obj,
|
|||
unsigned data_len = p_tx_obj->p.iic.data_len;
|
||||
unsigned idx = 0;
|
||||
uint32_t tag, *fifo = QUP_ADDR(id, QUP_OUTPUT_FIFO);
|
||||
const uint32_t *fifo_end = fifo + QUP_OUTPUT_FIFO_SIZE / sizeof(*fifo);
|
||||
|
||||
qup_reset_master_status(id);
|
||||
|
||||
qup_write32(QUP_ADDR(id, QUP_MX_OUTPUT_COUNT), data_len + 1);
|
||||
|
||||
qup_set_state(id, QUP_STATE_RUN);
|
||||
|
||||
/*
|
||||
|
@ -224,7 +225,6 @@ static qup_return_t qup_i2c_write_fifo(blsp_qup_id_t id, qup_data_t *p_tx_obj,
|
|||
idx++;
|
||||
|
||||
qup_write32(fifo, tag);
|
||||
fifo++;
|
||||
|
||||
while (data_len) {
|
||||
|
||||
|
@ -242,20 +242,13 @@ static qup_return_t qup_i2c_write_fifo(blsp_qup_id_t id, qup_data_t *p_tx_obj,
|
|||
}
|
||||
|
||||
qup_write32(fifo, tag);
|
||||
fifo++;
|
||||
|
||||
if ((fifo >= fifo_end) && data_len) {
|
||||
|
||||
fifo = QUP_ADDR(id, QUP_OUTPUT_FIFO);
|
||||
|
||||
ret = qup_i2c_write_fifo_flush(id);
|
||||
|
||||
if (ret) {
|
||||
printk(BIOS_DEBUG, "%s: error\n", __func__);
|
||||
printk(QUPDBG "%s: error\n", __func__);
|
||||
return ret;
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
ret = qup_i2c_write_fifo_flush(id);
|
||||
|
@ -272,6 +265,7 @@ static qup_return_t qup_i2c_write(blsp_qup_id_t id, uint8_t mode,
|
|||
|
||||
switch (mode) {
|
||||
case QUP_MODE_FIFO:
|
||||
case QUP_MODE_BLOCK:
|
||||
ret = qup_i2c_write_fifo(id, p_tx_obj, stop_seq);
|
||||
break;
|
||||
default:
|
||||
|
@ -321,10 +315,18 @@ static qup_return_t qup_i2c_read_fifo(blsp_qup_id_t id, qup_data_t *p_tx_obj)
|
|||
unsigned data_len = p_tx_obj->p.iic.data_len;
|
||||
unsigned idx = 0;
|
||||
uint32_t *fifo = QUP_ADDR(id, QUP_OUTPUT_FIFO);
|
||||
const uint32_t *fifo_end = fifo + QUP_INPUT_FIFO_SIZE / sizeof(*fifo);
|
||||
|
||||
qup_reset_master_status(id);
|
||||
|
||||
qup_write32(QUP_ADDR(id, QUP_IO_MODES),
|
||||
QUP_UNPACK_EN | QUP_PACK_EN |
|
||||
((QUP_MODE_BLOCK & QUP_MODE_MASK) <<
|
||||
QUP_OUTPUT_MODE_SHFT) |
|
||||
((QUP_MODE_BLOCK & QUP_MODE_MASK) <<
|
||||
QUP_INPUT_MODE_SHFT));
|
||||
|
||||
qup_write32(QUP_ADDR(id, QUP_MX_INPUT_COUNT), data_len);
|
||||
|
||||
qup_set_state(id, QUP_STATE_RUN);
|
||||
|
||||
qup_write32(fifo, (QUP_I2C_START_SEQ |
|
||||
|
@ -337,8 +339,6 @@ static qup_return_t qup_i2c_read_fifo(blsp_qup_id_t id, qup_data_t *p_tx_obj)
|
|||
return ret;
|
||||
}
|
||||
|
||||
qup_write32(QUP_ADDR(id, QUP_MX_READ_COUNT), data_len);
|
||||
|
||||
ret = qup_fifo_wait_for(id, INPUT_SERVICE_FLAG);
|
||||
if (ret) {
|
||||
printk(QUPDBG "%s: INPUT_SERVICE_FLAG\n", __func__);
|
||||
|
@ -352,7 +352,7 @@ static qup_return_t qup_i2c_read_fifo(blsp_qup_id_t id, qup_data_t *p_tx_obj)
|
|||
int count;
|
||||
|
||||
data = read32(fifo);
|
||||
fifo++;
|
||||
mdelay(1);
|
||||
|
||||
count = qup_i2c_parse_tag(data, data_ptr + idx, data_len);
|
||||
|
||||
|
@ -367,11 +367,7 @@ static qup_return_t qup_i2c_read_fifo(blsp_qup_id_t id, qup_data_t *p_tx_obj)
|
|||
idx += count;
|
||||
data_len -= count;
|
||||
|
||||
if ((fifo >= fifo_end) || (data_len == 0)) {
|
||||
fifo = QUP_ADDR(id, QUP_INPUT_FIFO);
|
||||
qup_write32(QUP_ADDR(id, QUP_OPERATIONAL),
|
||||
INPUT_SERVICE_FLAG);
|
||||
}
|
||||
qup_write32(QUP_ADDR(id, QUP_OPERATIONAL), INPUT_SERVICE_FLAG);
|
||||
}
|
||||
|
||||
p_tx_obj->p.iic.data_len = idx;
|
||||
|
@ -392,6 +388,7 @@ static qup_return_t qup_i2c_read(blsp_qup_id_t id, uint8_t mode,
|
|||
|
||||
switch (mode) {
|
||||
case QUP_MODE_FIFO:
|
||||
case QUP_MODE_BLOCK:
|
||||
ret = qup_i2c_read_fifo(id, p_tx_obj);
|
||||
break;
|
||||
default:
|
||||
|
@ -448,6 +445,7 @@ qup_return_t qup_init(blsp_qup_id_t id, const qup_config_t *config_ptr)
|
|||
/* Set QUP IO Mode */
|
||||
switch (config_ptr->mode) {
|
||||
case QUP_MODE_FIFO:
|
||||
case QUP_MODE_BLOCK:
|
||||
reg_val = QUP_UNPACK_EN | QUP_PACK_EN |
|
||||
((config_ptr->mode & QUP_MODE_MASK) <<
|
||||
QUP_OUTPUT_MODE_SHFT) |
|
||||
|
|
Loading…
Reference in New Issue