The theory of mobile robot behavioral dynamics is extended to three-dimensional space of manipulator, and applied to peg-in-hole assembly task. The assembly process is divided into the trend toward assembly target and assembly phase. In the phase of trend toward assembly target, the dynamic model of target acquisition and obstacle avoidance are established respectively, and these two kinds of behavior constitute a overall coupling and competitive robot dynamics model. In assembly phase, the posture adjustme...