Expression Graph-based equations for constraints

Features that implements the Geometric Relations between Geometric Features the package includes tests that can be run on romeo

tests usage

run rviz visualization

roslaunch romeo_description sot_display.launch

run pyton script, e.g.

cd python
ipython -i test_point-toward_angle.py