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:
committed by
Paul Fertser
parent
095ff3d210
commit
6fb9f2e3ee
@@ -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;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user