Added rotate matrix in place 90 deg