armv8: factor out generic bit set/clr for debug registers

introduce armv8_set_dbgreg_bits() function to make register 
bit-field modifications easier to read.


Change-Id: I6b06f66262587fd301d848c9e0645e8327653de7
Signed-off-by: Matthias Welwarsky <matthias.welwarsky@sysgo.com>
Reviewed-on: http://openocd.zylin.com/3989
Tested-by: jenkins
Reviewed-by: Paul Fertser <fercerpav@gmail.com>
This commit is contained in:
Matthias Welwarsky
2017-02-15 14:57:21 +01:00
committed by Paul Fertser
parent 095ff3d210
commit 6fb9f2e3ee
3 changed files with 23 additions and 17 deletions

View File

@@ -1292,3 +1292,24 @@ int armv8_get_gdb_reg_list(struct target *target,
}
}
}
int armv8_set_dbgreg_bits(struct armv8_common *armv8, unsigned int reg, unsigned long mask, unsigned long value)
{
uint32_t tmp;
/* Read register */
int retval = mem_ap_read_atomic_u32(armv8->debug_ap,
armv8->debug_base + reg, &tmp);
if (ERROR_OK != retval)
return retval;
/* clear bitfield */
tmp &= ~mask;
/* put new value */
tmp |= value & mask;
/* write new value */
retval = mem_ap_write_atomic_u32(armv8->debug_ap,
armv8->debug_base + reg, tmp);
return retval;
}