update USALS rotor method to use motor angle and not azimuth. Copied from tune-s2 application which is most correct implementation available