Draft: Change polar coordinate conversion
Use normal polar coordinates conversion.
This is tested on ArmarDE and works properly but will probably not work on Armar6.
Use normal polar coordinates conversion.
This is tested on ArmarDE and works properly but will probably not work on Armar6.