Add compute_features utility

* Fix small bug in Helbing's compute feature
* Reverse weights while planning when using Abbeel's learning
Remove wrong anisotropic directory
Fix preprocess to correctly compute velocities
Add "smoke tests" check scripts