Begin adding new method to ARC_IMU got return endpoints of line matching slope from roation matrix