Added ShiftMatrix routines