[Pdbg] [PATCH 10/19] libpdbg: Add pib driver using sbefifo

[Amitay Isaacs]

Signed-off-by: Amitay Isaacs <amitay at ozlabs.org>
---
 libpdbg/sbefifo.c | 29 +++++++++++++++++++++++++++++
 1 file changed, 29 insertions(+)

diff --git a/libpdbg/sbefifo.c b/libpdbg/sbefifo.c
index d8a87a7..486d15e 100644
--- a/libpdbg/sbefifo.c
+++ b/libpdbg/sbefifo.c
@@ -221,6 +221,22 @@ static int sbefifo_op_thread_sreset(struct chipop *chipop,
 	return sbefifo_op_control(chipop, core_id, thread_id, SBEFIFO_INSN_OP_SRESET);
 }
 
+static int sbefifo_pib_read(struct pib *pib, uint64_t addr, uint64_t *val)
+{
+	struct sbefifo *sbefifo = target_to_sbefifo(pib->target.parent);
+	struct sbefifo_context *sctx = sbefifo->get_sbefifo_context(sbefifo);
+
+	return sbefifo_scom_get(sctx, addr, val);
+}
+
+static int sbefifo_pib_write(struct pib *pib, uint64_t addr, uint64_t val)
+{
+	struct sbefifo *sbefifo = target_to_sbefifo(pib->target.parent);
+	struct sbefifo_context *sctx = sbefifo->get_sbefifo_context(sbefifo);
+
+	return sbefifo_scom_put(sctx, addr, val);
+}
+
 static struct sbefifo_context *sbefifo_op_get_context(struct sbefifo *sbefifo)
 {
 	return sbefifo->sf_ctx;
@@ -288,6 +304,18 @@ static struct chipop sbefifo_chipop = {
 };
 DECLARE_HW_UNIT(sbefifo_chipop);
 
+static struct pib sbefifo_pib = {
+	.target = {
+		.name = "SBE FIFO Chip-op based PIB",
+		.compatible = "ibm,sbefifo-pib",
+		.class = "pib",
+	},
+	.read = sbefifo_pib_read,
+	.write = sbefifo_pib_write,
+	.fd = -1,
+};
+DECLARE_HW_UNIT(sbefifo_pib);
+
 static struct sbefifo kernel_sbefifo = {
 	.target = {
 		.name =	"Kernel based FSI SBE FIFO",
@@ -305,6 +333,7 @@ static void register_sbefifo(void)
 {
 	pdbg_hwunit_register(PDBG_DEFAULT_BACKEND, &kernel_sbefifo_hw_unit);
 	pdbg_hwunit_register(PDBG_DEFAULT_BACKEND, &sbefifo_chipop_hw_unit);
+	pdbg_hwunit_register(PDBG_DEFAULT_BACKEND, &sbefifo_pib_hw_unit);
 	pdbg_hwunit_register(PDBG_DEFAULT_BACKEND, &sbefifo_mem_hw_unit);
 	pdbg_hwunit_register(PDBG_DEFAULT_BACKEND, &sbefifo_pba_hw_unit);
 }
-- 
2.24.1