Add shift matrix operation, will be needed for finding shortest path