Розв`язання прямої задачі кінематики робота-маніпулятора з чотирма ступенями свободи

Abstract

The development of science and technology has significantly changed the approach to industrial operations, especially in the field of automation. The growing demand for high-quality products has led to the transition toward automated systems that use robots to replace humans in performing repetitive tasks. Industrial robotic manipulators are widely used in manufacturing processes such as welding, painting, assembly, cutting, and others. This work presents a mathematical description of solving the forward kinematics problem for the educational robotic manipulator with four degrees of freedom. The algorithm is proposed for the procedure of forming a sequence of consistent coordinate systems associated with the manipulator’s links. An orthonormal coordinate system has been established for each of the four links. During the task execution, the structure of the manipulator was described. The external appearance of the manipulator is presented, along with its 3D-model and structural-kinematic diagram. Based on the obtained parameters and the matrixbased method of coordinate representation using the Denavit–Hartenberg convention, transformation matrices were constructed, which mathematically represent the spatial positions of each manipulator link. The use of the Denavit–Hartenberg transformation made it possible to determine the spatial position of each of the four kinematic pairs of the robotic manipulator. Based on the proposed algorithm, a computer program was developed using Visual C#, which allows for automatically obtaining the spatial coordinates of each kinematic pair as well as the trajectory of the end effector from the initial to the target point. In this way, the planned movement is first tested in a virtual simulation environment and executed on the physical robot only after verification. The proposed method and software are universal and can be used for simulating any robotic manipulator in the educational process. The functioning of the developed software is described in detail, including code fragments that perform the calculation of the coordinates of the respective kinematic pairs within the manipulator’s working area, as well as the end effector’s movement trajectory in space. As a result of the calculations and the schematic representation of the 3D-model, the spatial positions of the manipulator links fully match the predefined target positions, confirming the adequacy of the developed model and its software implementation. In the future, based on this model, it is planned to synthesize a control system for the educational robotic manipulator and to implement the inverse kinematics solution.

Розвиток науки й техніки суттєво змінив підхід до функціонування промисловості, особливо в га-лузі автоматизації. Зростаючий попит на високоякісну продукцію призвів до переходу на автомати-зовані системи, які використовують роботів для заміни людини у виконанні повторюваних завдань. Промислові роботи-мані пулятори широко застосовуються утаких виробничих процесах, як зварю-вання, фарбування, складання, різання тощо.В роботі подано математичний опис розв`язанняпрямої задачі кінематики для навчального робота-маніпулятора з чотирма ступенями свободи. Запропонованоалгоритм процедури форму-вання послідовності узгоджених систем координат, пов`язаних з ланками маніпулятора.Сформовано ортонормовану системукоординат для кожної з чотирьох ланок.Дляви конання поставлених завдань описано структуруманіпулятора,наведено зовнішній вигляд маніпулятора, запропоновано 3D-модель та структурно-кінематичну схему. На основі отриманихпараметрів та матричного методу представлення побудови системикоординат Денавіта–Хартенберга створено матриці перетворень, які математично представляють просторові поло-ження кожної з ланок маніпулятора. Використання перетворення Денавіта–Хантерберга дало змогу отримати положення кожної з чотирьох кінематичних пар робота-маніпулятора в просторі.За алгоритмом розробленокомп`ютерн упрограм уна Visual C, яка дозволяє автоматично отри-мати координати кожної з кінематичних пар у просторі а також траєкторію руху захоплювачаз по-чаткової точки в задану. Таким чином, запланований рух спочатку перевіряється у віртуальному середовищі моделювання, і лише після перевірки виконується реальним роботом. Запропонована методика та комп`ютерна програма є універсальними та можуть бути викорис-тані для моделювання будь-якого робота-маніпулятора в навчальному процесі.Здійснено опис процесу функціонування створеної програми, наведено фрагменти програмного коду, які здійснюють розрахункикоординат відповідних кінематичних пар в зоні обслуговування мані-пулятора та безпосередньотрає кторію руху самого захоплювачав просторі. В результаті розраху-нків та схематичного представлення 3D-моделі положення ланок маніпулятора в просторі повністю збігаються ізнапередзаданим положенням, що свідчить про адекватність створеної моделі та її програмної реалізації. Надалі на основі цієї моделі заплановано синтезувати систему керування нав-чальним роботом-маніпулятором, а також реалізацію зворотної задачі кінематики