added new data-strcutures for new sensors new helper methods fixed some issues
fixed issue with angles [bad interface] - adjusted other parts accordingly - added corresponding test-cases started working on absolute heading