Using angles to compute angles

- deleted sign fuction implementation
- using ros angles library to compute angles