Fixed an earlier bug, reswapped the angles, works perfectly now. Haven't tried it in orbits yet