Add ldm stm load/store multiple registers function