Lines Matching +full:self +full:- +full:powered
1 // SPDX-License-Identifier: GPL-2.0
27 #include "coresight-priv.h"
67 * 0b0000 - Sample offset applies based on the instruction state, we
69 * 0b0001 - No offset applies.
70 * 0b0010 - No offset applies, but do not use in AArch32 mode
115 writel_relaxed(0x0, drvdata->base + EDOSLAR); in debug_os_unlock()
127 * - CPU power domain is powered off;
128 * - The OS Double Lock is locked;
134 /* CPU is powered off */ in debug_access_permitted()
135 if (!(drvdata->edprsr & EDPRSR_PU)) in debug_access_permitted()
139 if (drvdata->edprsr & EDPRSR_DLK) in debug_access_permitted()
157 edprcr = readl_relaxed(drvdata->base + EDPRCR); in debug_force_cpu_powered_up()
159 writel_relaxed(edprcr, drvdata->base + EDPRCR); in debug_force_cpu_powered_up()
161 /* Wait for CPU to be powered up (timeout~=32ms) */ in debug_force_cpu_powered_up()
162 if (readx_poll_timeout_atomic(readl_relaxed, drvdata->base + EDPRSR, in debug_force_cpu_powered_up()
163 drvdata->edprsr, (drvdata->edprsr & EDPRSR_PU), in debug_force_cpu_powered_up()
166 * Unfortunately the CPU cannot be powered up, so return in debug_force_cpu_powered_up()
171 dev_err(drvdata->dev, "%s: power up request for CPU%d failed\n", in debug_force_cpu_powered_up()
172 __func__, drvdata->cpu); in debug_force_cpu_powered_up()
177 * At this point the CPU is powered up, so set the no powerdown in debug_force_cpu_powered_up()
180 edprcr = readl_relaxed(drvdata->base + EDPRCR); in debug_force_cpu_powered_up()
182 writel_relaxed(edprcr, drvdata->base + EDPRCR); in debug_force_cpu_powered_up()
184 drvdata->edprsr = readl_relaxed(drvdata->base + EDPRSR); in debug_force_cpu_powered_up()
187 if (unlikely(!(drvdata->edprsr & EDPRSR_PU))) in debug_force_cpu_powered_up()
195 CS_UNLOCK(drvdata->base); in debug_read_regs()
201 save_edprcr = readl_relaxed(drvdata->base + EDPRCR); in debug_read_regs()
212 drvdata->edpcsr = readl_relaxed(drvdata->base + EDPCSR); in debug_read_regs()
216 * element (PE) is in debug state, or sample-based in debug_read_regs()
221 if (drvdata->edpcsr == EDPCSR_PROHIBITED) in debug_read_regs()
225 * A read of the EDPCSR normally has the side-effect of in debug_read_regs()
230 drvdata->edpcsr_hi = readl_relaxed(drvdata->base + EDPCSR_HI); in debug_read_regs()
232 if (drvdata->edcidsr_present) in debug_read_regs()
233 drvdata->edcidsr = readl_relaxed(drvdata->base + EDCIDSR); in debug_read_regs()
235 if (drvdata->edvidsr_present) in debug_read_regs()
236 drvdata->edvidsr = readl_relaxed(drvdata->base + EDVIDSR); in debug_read_regs()
240 writel_relaxed(save_edprcr, drvdata->base + EDPRCR); in debug_read_regs()
242 CS_LOCK(drvdata->base); in debug_read_regs()
248 return (unsigned long)drvdata->edpcsr_hi << 32 | in debug_adjust_pc()
249 (unsigned long)drvdata->edpcsr; in debug_adjust_pc()
257 pc = (unsigned long)drvdata->edpcsr; in debug_adjust_pc()
259 if (drvdata->pc_has_offset) { in debug_adjust_pc()
266 pc = (pc & EDPCSR_THUMB_INST_MASK) - thumb_inst_offset; in debug_adjust_pc()
277 dev_emerg(drvdata->dev, in debug_adjust_pc()
280 pc = (pc & EDPCSR_ARM_INST_MASK) - arm_inst_offset; in debug_adjust_pc()
288 struct device *dev = drvdata->dev; in debug_dump_regs()
292 drvdata->edprsr, in debug_dump_regs()
293 drvdata->edprsr & EDPRSR_PU ? "On" : "Off", in debug_dump_regs()
294 drvdata->edprsr & EDPRSR_DLK ? "Lock" : "Unlock"); in debug_dump_regs()
301 if (drvdata->edpcsr == EDPCSR_PROHIBITED) { in debug_dump_regs()
309 if (drvdata->edcidsr_present) in debug_dump_regs()
310 dev_emerg(dev, " EDCIDSR: %08x\n", drvdata->edcidsr); in debug_dump_regs()
312 if (drvdata->edvidsr_present) in debug_dump_regs()
314 drvdata->edvidsr, in debug_dump_regs()
315 drvdata->edvidsr & EDVIDSR_NS ? in debug_dump_regs()
316 "Non-secure" : "Secure", in debug_dump_regs()
317 drvdata->edvidsr & EDVIDSR_E3 ? "EL3" : in debug_dump_regs()
318 (drvdata->edvidsr & EDVIDSR_E2 ? in debug_dump_regs()
320 drvdata->edvidsr & EDVIDSR_HV ? 64 : 32, in debug_dump_regs()
321 drvdata->edvidsr & (u32)EDVIDSR_VMID); in debug_dump_regs()
330 CS_UNLOCK(drvdata->base); in debug_init_arch_data()
333 eddevid = readl_relaxed(drvdata->base + EDDEVID); in debug_init_arch_data()
334 eddevid1 = readl_relaxed(drvdata->base + EDDEVID1); in debug_init_arch_data()
336 CS_LOCK(drvdata->base); in debug_init_arch_data()
342 drvdata->edpcsr_present = false; in debug_init_arch_data()
343 drvdata->edcidsr_present = false; in debug_init_arch_data()
344 drvdata->edvidsr_present = false; in debug_init_arch_data()
345 drvdata->pc_has_offset = false; in debug_init_arch_data()
349 drvdata->edvidsr_present = true; in debug_init_arch_data()
352 drvdata->edcidsr_present = true; in debug_init_arch_data()
362 drvdata->edpcsr_present = in debug_init_arch_data()
366 drvdata->pc_has_offset = in debug_init_arch_data()
377 static int debug_notifier_call(struct notifier_block *self, in debug_notifier_call() argument
397 dev_emerg(drvdata->dev, "CPU[%d]:\n", drvdata->cpu); in debug_notifier_call()
420 * been powered on and use it to handle failure case. in debug_enable_func()
429 ret = pm_runtime_get_sync(drvdata->dev); in debug_enable_func()
445 pm_runtime_put_noidle(drvdata->dev); in debug_enable_func()
466 ret = pm_runtime_put(drvdata->dev); in debug_disable_func()
563 struct device *dev = &adev->dev; in debug_probe()
565 struct resource *res = &adev->res; in debug_probe()
570 return -ENOMEM; in debug_probe()
572 drvdata->cpu = coresight_get_cpu(dev); in debug_probe()
573 if (drvdata->cpu < 0) in debug_probe()
574 return drvdata->cpu; in debug_probe()
576 if (per_cpu(debug_drvdata, drvdata->cpu)) { in debug_probe()
578 drvdata->cpu); in debug_probe()
579 return -EBUSY; in debug_probe()
582 drvdata->dev = &adev->dev; in debug_probe()
590 drvdata->base = base; in debug_probe()
593 per_cpu(debug_drvdata, drvdata->cpu) = drvdata; in debug_probe()
594 ret = smp_call_function_single(drvdata->cpu, debug_init_arch_data, in debug_probe()
599 dev_err(dev, "CPU%d debug arch init failed\n", drvdata->cpu); in debug_probe()
603 if (!drvdata->edpcsr_present) { in debug_probe()
604 dev_err(dev, "CPU%d sample-based profiling isn't implemented\n", in debug_probe()
605 drvdata->cpu); in debug_probe()
606 ret = -ENXIO; in debug_probe()
622 dev_info(dev, "Coresight debug-CPU%d initialized\n", drvdata->cpu); in debug_probe()
626 debug_count--; in debug_probe()
628 per_cpu(debug_drvdata, drvdata->cpu) = NULL; in debug_probe()
634 struct device *dev = &adev->dev; in debug_remove()
637 per_cpu(debug_drvdata, drvdata->cpu) = NULL; in debug_remove()
645 if (!--debug_count) in debug_remove()
659 CS_AMBA_ID(0x000bbd03), /* Cortex-A53 */
660 CS_AMBA_ID(0x000bbd07), /* Cortex-A57 */
661 CS_AMBA_ID(0x000bbd08), /* Cortex-A72 */
662 CS_AMBA_ID(0x000bbd09), /* Cortex-A73 */
672 .name = "coresight-cpu-debug",