Testing code for the InterbotiX WidowX Arm