Моделирование ограничений на относительное движение шарнирно связанных тел в системах виртуального окружения

Abstract

The topic of this paper is a real-time simulation of the dynamics of a system of articulated rigid bodies with restrictions on their relative motion. Restrictions are set in the form of inequalities for the relative angles of rotation (for the rotational joints) or relative displacement (for the prismatic joints) of links. Examples of such systems are robots and manipulators, mobile vehicles with trailers, hinged doors, etc. This problem can be presented as a system of linear algebraic equations with linear complements. As a solution for this system the authors propose the method of sequential impulses utilizing a temporal coherence property, which means that the state of a multi-body system (their coordinates) varies slightly for a small period of time. The semi-implicit Euler method is used as the difference scheme. Since the problem presented in the form of a system of linear equations with linear complements is solved relative to velocities, it is necessary to ensure achievement of constraints relative to the body coordinates (task of constraint stabilization). For such a stabilization the authors propose to use the method of split impulses, which ensures stability of the dynamics simulation for a multi-body system. In this paper the authors consider methods used both for the open and closed kinematic chains. The proposed methods and algorithms are implemented in the program modules in the form of dynamic libraries for Windows OS. Their approbation was carried out in the subsystem of dynamics simulation performing simulation of the robots containing joints with restrictions on the parameters of the relative motion. Studies have shown that the proposed methods and algorithms meet the requirements for the dynamics simulation subsystems of the simulators for control of complex dynamic processes, and virtual environment systems. Such technologies can also be used in virtual labs, simulation complexes, systems of augmented virtual environment and other applications.