Improved youbot arm control with xsens IMUs