Robotics package for modeling and control of robot