Phil unstable

First try with the pull request (as requested...). I added two methods in the SensorPolar2D two, because I need do access two of the members for the ohm_tsdSlam package.