Added test for usonic
No more sqrt, added minor changes to main.