cleaned up main imports
removed unused parameters
refactoring
Improved leg angle & motion