Tentative change to use rotation matricies