| Message ID | 20200421041655.82856-15-amitay@ozlabs.org |
|---|---|
| State | Superseded |
| Headers | show |
| Series | Add sbefifo backend | expand |
| Context | Check | Description |
|---|---|---|
| snowpatch_ozlabs/apply_patch | success | Successfully applied on branch master (6ae2ba655ca5e24b403a33bf15dff7261d3e7052) |
| snowpatch_ozlabs/build-multiarch | success | Test build-multiarch on branch master |
Reviewed-by: Alistair Popple <alistair@popple.id.au> On Tuesday, 21 April 2020 2:16:50 PM AEST Amitay Isaacs wrote: > Signed-off-by: Amitay Isaacs <amitay@ozlabs.org> > --- > libpdbg/sbefifo.c | 51 +++++++++++++++++++++++++++++++++++++++++++++++ > 1 file changed, 51 insertions(+) > > diff --git a/libpdbg/sbefifo.c b/libpdbg/sbefifo.c > index eeb8d5c..935a891 100644 > --- a/libpdbg/sbefifo.c > +++ b/libpdbg/sbefifo.c > @@ -271,6 +271,53 @@ static int sbefifo_pib_write(struct pib *pib, uint64_t > addr, uint64_t val) return sbefifo_scom_put(sctx, addr, val); > } > > +static int sbefifo_pib_thread_op(struct pib *pib, uint32_t oper) > +{ > + struct sbefifo *sbefifo = target_to_sbefifo(pib->target.parent); > + struct sbefifo_context *sctx = sbefifo->get_sbefifo_context(sbefifo); > + uint32_t core_id, thread_id; > + uint8_t mode = 0; > + > + /* > + * core_id = 0xff (all SMT4 cores) > + * thread_id = 0xf (all 4 threads in the SMT4 core) > + */ > + core_id = 0xff; > + thread_id = 0xf; > + > + /* Enforce special-wakeup for thread stop and sreset */ > + if ((oper & 0xf) == SBEFIFO_INSN_OP_STOP || > + (oper & 0xf) == SBEFIFO_INSN_OP_SRESET) > + mode = 0x2; > + > + return sbefifo_control_insn(sctx, core_id, thread_id, oper, mode); > +} > + > +static int sbefifo_pib_thread_start(struct pib *pib) > +{ > + return sbefifo_pib_thread_op(pib, SBEFIFO_INSN_OP_START); > +} > + > +static int sbefifo_pib_thread_stop(struct pib *pib) > +{ > + return sbefifo_pib_thread_op(pib, SBEFIFO_INSN_OP_STOP); > +} > + > +static int sbefifo_pib_thread_step(struct pib *pib, int count) > +{ > + int i, rc = 0; > + > + for (i = 0; i < count; i++) > + rc |= sbefifo_pib_thread_op(pib, SBEFIFO_INSN_OP_STEP); > + > + return rc; > +} > + > +static int sbefifo_pib_thread_sreset(struct pib *pib) > +{ > + return sbefifo_pib_thread_op(pib, SBEFIFO_INSN_OP_SRESET); > +} > + > static int sbefifo_thread_probe(struct pdbg_target *target) > { > struct thread *thread = target_to_thread(target); > @@ -409,6 +456,10 @@ static struct pib sbefifo_pib = { > }, > .read = sbefifo_pib_read, > .write = sbefifo_pib_write, > + .thread_start_all = sbefifo_pib_thread_start, > + .thread_stop_all = sbefifo_pib_thread_stop, > + .thread_step_all = sbefifo_pib_thread_step, > + .thread_sreset_all = sbefifo_pib_thread_sreset, > .fd = -1, > }; > DECLARE_HW_UNIT(sbefifo_pib);
diff --git a/libpdbg/sbefifo.c b/libpdbg/sbefifo.c index eeb8d5c..935a891 100644 --- a/libpdbg/sbefifo.c +++ b/libpdbg/sbefifo.c @@ -271,6 +271,53 @@ static int sbefifo_pib_write(struct pib *pib, uint64_t addr, uint64_t val) return sbefifo_scom_put(sctx, addr, val); } +static int sbefifo_pib_thread_op(struct pib *pib, uint32_t oper) +{ + struct sbefifo *sbefifo = target_to_sbefifo(pib->target.parent); + struct sbefifo_context *sctx = sbefifo->get_sbefifo_context(sbefifo); + uint32_t core_id, thread_id; + uint8_t mode = 0; + + /* + * core_id = 0xff (all SMT4 cores) + * thread_id = 0xf (all 4 threads in the SMT4 core) + */ + core_id = 0xff; + thread_id = 0xf; + + /* Enforce special-wakeup for thread stop and sreset */ + if ((oper & 0xf) == SBEFIFO_INSN_OP_STOP || + (oper & 0xf) == SBEFIFO_INSN_OP_SRESET) + mode = 0x2; + + return sbefifo_control_insn(sctx, core_id, thread_id, oper, mode); +} + +static int sbefifo_pib_thread_start(struct pib *pib) +{ + return sbefifo_pib_thread_op(pib, SBEFIFO_INSN_OP_START); +} + +static int sbefifo_pib_thread_stop(struct pib *pib) +{ + return sbefifo_pib_thread_op(pib, SBEFIFO_INSN_OP_STOP); +} + +static int sbefifo_pib_thread_step(struct pib *pib, int count) +{ + int i, rc = 0; + + for (i = 0; i < count; i++) + rc |= sbefifo_pib_thread_op(pib, SBEFIFO_INSN_OP_STEP); + + return rc; +} + +static int sbefifo_pib_thread_sreset(struct pib *pib) +{ + return sbefifo_pib_thread_op(pib, SBEFIFO_INSN_OP_SRESET); +} + static int sbefifo_thread_probe(struct pdbg_target *target) { struct thread *thread = target_to_thread(target); @@ -409,6 +456,10 @@ static struct pib sbefifo_pib = { }, .read = sbefifo_pib_read, .write = sbefifo_pib_write, + .thread_start_all = sbefifo_pib_thread_start, + .thread_stop_all = sbefifo_pib_thread_stop, + .thread_step_all = sbefifo_pib_thread_step, + .thread_sreset_all = sbefifo_pib_thread_sreset, .fd = -1, }; DECLARE_HW_UNIT(sbefifo_pib);
Signed-off-by: Amitay Isaacs <amitay@ozlabs.org> --- libpdbg/sbefifo.c | 51 +++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 51 insertions(+)