Adding code useful for moving robot joints