Ahí pude encontrar el error, el tema fue que como atan me devuelve 2 valores distintos yo estaba eligiendo el incorrecto siempre. Lo corregí, lo grafiqué y me dio la orbita correctamente.
Muchas gracias por la ayuda!
Muchas gracias por la ayuda!