A robot simulation, planning, and control package from Indiana University