Improve Python3 support + some new features
- Most of the tests have been patched to run on Python3.
- Code refactored for better readability
- Merge forward reachability PR (thank @herjia )
- Merge Joint Torque constraint with friction (thank @Linjackffy )
- Documentation moved to readthedocs