aarch64: optimize core state detection

Replace loop by right-shift.
Inspired by patch from Alamy Liu

Change-Id: I1285f4f54c0695a93fa42e9863ed8ffa4de00f70
Signed-off-by: Matthias Welwarsky <matthias.welwarsky@sysgo.com>
Reviewed-on: http://openocd.zylin.com/3985
Tested-by: jenkins
Reviewed-by: Paul Fertser <fercerpav@gmail.com>
This commit is contained in:
Matthias Welwarsky 2016-11-15 22:10:03 +01:00 committed by Paul Fertser
parent fa8700cdd5
commit 7ed0b6333d
1 changed files with 2 additions and 8 deletions

View File

@ -51,17 +51,11 @@ enum arm_state armv8_dpm_get_core_state(struct arm_dpm *dpm)
{
int el = (dpm->dscr >> 8) & 0x3;
int rw = (dpm->dscr >> 10) & 0xF;
int pos;
dpm->last_el = el;
/* find the first '0' in DSCR.RW */
for (pos = 3; pos >= 0; pos--) {
if ((rw & (1 << pos)) == 0)
break;
}
if (el > pos)
/* In Debug state, each bit gives the current Execution state of each EL */
if ((rw >> el) & 0b1)
return ARM_STATE_AARCH64;
return ARM_STATE_ARM;