مدل‌سازی و کنترل ربات 3prs با استفاده از روش لاگرانژ

در این پژوهش، سینماتیک و دینامیک یک ربات موازی از نوع 3prs مورد بررسی قرار گرفت. و به روش گشتاور معین (ctm) برای آن کنترلر طراحی گردید. همچنین برای دفع اغتشاشات، از یک کنترلر pd استفاده شد. این ربات، نوعی مکانیزم موازی فضایی با شش درجه آزادی است؛ که به وسیله‌ی سه مفصل لغزنده فعال و سه مفصل دورانی غیرفعال کنترل می‌شود؛ و در گروه مکانیزم های مقید طبقه بندی شده است. تحلیل سینماتیک ربات با ‌استفاده از ماتریس‌های انتقال همگن و ماتریس ژاکوبین مربوطه انجام شد. در نتیجه، روابط موقعیت و سرعت بین فضای کاری و فضای مفاصل ربات، در هردو مسیر مستقیم و معکوس استخراج شد؛ و مسیرهای متفاوت رسیدن به نقطه مقصد در پلتفرم تعیین گردید. معادلات دینامیکی حاکم بر مساله، به روش لاگرانژ، در فضای مفاصل و با در نظر گرفتن ضرایب لاگرانژ استخراج گردید. و در نهایت، به حذف این ضرایب با استفاده از ماتریس پوچی پرداخته شد. در نتیجه، حل سینتیک مستقیم و معکوس مکانیزم به دست آمد. نهایتا، کنترل ربات با کمک معادلات دینامیکی سیستم و استفاده از روش گشتاور معین انجام شد. تمام مدل سازی ها با کمک شبیه سازی در نرم افزار matlab و مقایسه مسیرهای حل در سناریوهای مستقیم و معکوس صحه سنجی شد. برای این کار از محیط simmechnics استفاده گردید. نتایج شبیه سازی نشان می‌دهد که، با استفاده از مدل ریاضی و کنترلر یاد شده، به سادگی می‌توان هر مسیر دلخواهی را در فضای کاری طی کرد.

Modeling and Control of a 3PRS Robot Using Lagrange Method

Kinematic and Kinetic Modeling of a 3PRS mechanism is performed in this paper and its related controller is designed according to Computed Torque Method (CTM). This mechanism is a kind of spatial parallel robot with 6 DOFs, which is controlled using three active prismatic joints and three passive revolute joints and thus the system is categorized as constrained mechanism. Kinematic modeling of the robot is performed using Homogenous transformation matrix and its related Jacobian matrix is exracted. Therefore the position and velocity relation between the joint space and workspace are provided both in its direct and inverse modes. Dynamic equation of the system is also derived using Lagrange equation in the joint space of the robot and considering Lagrange multipliers in order to engage the related constraints of the system. Thus both of forward and inverse kinetic of the system are solved for the presented system. Finally, by the aid of the extracted dynamic equation, the robot is controlled using Computed Torque Method (CTM) equipped by a PD controller for compensatingthe uncertainties and disturbances. All of the modeling are verified by simulating the equations in MATLAB and comparing the direct and inverse modes. It is shown that using the extracted modeling and the designed controller for this parallel robot, the desired path can be easily tracked within the workspace of the robot.