Research on autonomous working of articulated robot by sensor fusion