The level of packing automation increase rapidly. To realize different complex packing，using the robot system to simulate the movement of human hands is just needed. This paper using trajectory planning based on spline function，rigid robot Lagrangian kinetics set up system mathematical model. This method offers a new thought way for designing automation packing rigid robot system.