temp commit... almost completely working
Check in ready version of essential matrix class
Fix error in polynomial tests