Working! Just add estimations for phi and theta
All working. LL for test data looks weird though