Do register level maths

Signed-off-by: Prashant Shah <pshah.mumbai@gmail.com>