SU729545A1 - Manipulator control system - Google Patents

Description

Изобретение относитс  к робототехнике и может использоватьс  при создании высокоточных и малогабаритных систем управлени  манипул тором Известна система управлени  манипул тором , содержаща  датчики усилий задающего органа и последовательно соединенные блок астатического управ лени , блок след щих приводов и датчики усилий, исполнительного органа 1 . Однако така  система не позвсэл ет оператору дозировать усили , развиваемые исполнительным.органом. Наиболее близким к предлагаемому изобретению система управлени  мани пул тором, содержаща  датчики момента задающего органа, последовательно соединенные блок астатического управлени , блок приводов исполнительного органа, датчики момента исполнительного органа и вычисли-, тельный блок, вторые входы которого соединены с выходами датчиков момента задающего органа, а первые выходы - с соответствующими входами блока астатического управлени  2. Эта система позвол ет дозировать усили , развиваемые исполнительным органом. Однако така  система не обладает свойством активного отраже .ни  усилий исполнительного органа, что сужает круг операций, выполн емых манипул тором, и эффективно работает лишь при качественной визуальной обратной св зи. Цель изобретени  -.расширение области применени  системы. Это достигаетс  тем, что система содержит последовательно соединенные сумматор, блок приводов задающего органа и блок преобразовани  координат, выходы которого подключены к первым входам сумматора, вторые входы которого соединены с соответствующими выходами вычислительного блока. На чертеже приведена функциональна  схема системы управлени  манипул тором . Она содержит задающий орган т, датчики 2 момента задающего органа, блок 3 приводов задающего органа, вычислительный блок 4, блок 5 астатического управлени , блок 6 приводов исполнительного органа, датчики 7 момента исполнительного органа, исполнительный орган 8, сумматор 9, ;блок 10 преобразовани  координат.The invention relates to robotics and can be used to create highly accurate and compact manipulator control systems. A known control system for a manipulator, comprising force sensors of a driver, and an astatic control unit connected in series, a servo drive unit and force sensors of the actuator 1. However, such a system does not allow the operator to dispense efforts developed by the executive body. The closest to the proposed invention is a control system for a manipulator containing sensors of the moment of the driver, serially connected astatic controls, actuators of the actuator, sensors of the actuator and computing unit, the second inputs of which are connected to the outputs of the moment of the driver, and the first exits - with the corresponding inputs of the static control unit 2. This system allows to measure the efforts developed by the executive body. However, such a system does not possess the property of active reflection of the efforts of the executive body, which limits the range of operations performed by the manipulator, and effectively works only with high-quality visual feedback. The purpose of the invention is to expand the scope of the system. This is achieved by the fact that the system contains a series-connected adder, a driver unit of the driver, and a coordinate conversion unit, the outputs of which are connected to the first inputs of the adder, the second inputs of which are connected to the corresponding outputs of the computing unit. The drawing shows a functional diagram of the control system of the manipulator. It contains the master body, the torque body sensors 2, the master body drive unit 3, the computing unit 4, the static control unit 5, the executive body drive unit 6, the executive body torque sensors 7, the executive body 8, the adder 9,; conversion unit 10 coordinates.

датчики 11 положени  задающего органа.sensors 11 position master body.

Система работает следующим образом.The system works as follows.

Дл  того,чтобы переместить захват сполнительного органа 8, оператор приклсщывает к задающему органу 1 некоторое усилие. При этом с датчиков 2 момента задающего органа 1 и датчиков 7 момента испол-нитель- ного органа 8 на вычислительный блок 4 будут поступать сигналы, пропорциональные усили м, приложенным к задающему 1 и исполнительно му 8 органам. Вычислительный -блок. 4 пересчитывает усили , приложенные ператором к задающему органу 1, и усили , приложенные к исполнитель ному органу 8 к одной системе координат , и формирует их разность,In order to move the grip of the filling body 8, the operator applies some force to the setting body 1. In this case, from sensors 2 of the moment of the setting body 1 and sensors 7 of the moment of the executive body 8, the computing unit 4 will receive signals proportional to the forces applied to the specifying 1 and executive 8 bodies. Computational block. 4 recalculates the forces applied by the operator to the specifying body 1, and the forces applied to the executive body 8 to the same coordinate system, and forms their difference,

Сигналы, пропорциональные этой разности, поступают на вход блока 5 астатического управлени , обеспечива  перемещение захвата исполнительного органа 8 со скоростью, пропорциональной разности усилий, приложенных к задающему 1 и исполнительному 8 органам.Signals proportional to this difference are fed to the input of astatic control unit 5, providing movement of the gripper of the executive body 8 at a speed proportional to the difference of the forces applied to the specifier 1 and the executive 8 bodies.

При соответствующем выборе коэффициентов усилени  блока 5 астатического управлени  малыми перемещени ми задающего органа 1 можно обеспечить требуемую скорость, движени  захвата исполнительного органа 8. With an appropriate choice of the gains of the block 5 of the static control of the small displacements of the setting body 1, it is possible to provide the required speed, the movement of the gripping of the executive body 8.

Сигнал, пропорциональный разности усилий, поступает также на входы блока 3 приводов задающего органа, которые формируют на задающем органе ,1 усили , действующие на оператора, т.е, дл  того, чтобы обеспечить дви- жение захвата исполнительного органа 8 в определенную сторону, оператор должен приложить к задающему; органу 1 усилие, прейышающее усилие, приложенное к исполнительному органу 8.A signal proportional to the difference in effort is also fed to the inputs of the block 3 of the actuator of the driver, which forms on the driver, 1 force acting on the operator, i.e., in order to ensure the capture of the executive body 8 in a certain direction, the operator must attach to the master; body 1 effort, tremendous effort applied to the executive body 8.

Блок 10 преобразовани  координат рассчитывает положение руко тки .(конечной точки) задающего органа, 1 из положений его степеней подвижности , которые измер ютс  датчиками положени  задающего органа.The coordinate conversion unit 10 calculates the position of the handle (end point) of the driver, 1 from the positions of its degrees of mobility, which are measured by the sensors of the position of the driver.

Применение изобретени  позволит повысить производительность и эффективность работы оператора за счет активного отражени  на задающем органе усилий, развиваемых исполниэфтельным органом, что создаетThe application of the invention will improve the productivity and efficiency of the operator due to the active reflection on the master body of the efforts developed by the executive authority, which creates

фект присутстви  оператора в зоне работы манипул тора.The presence of the operator in the area of the manipulator operation.

Claims (2)

1.Авторское свидетельство СССР №271252, кл. В 25 J 3/04, 13.05,69,1. USSR author's certificate No. 271252, cl. B 25 J 3/04, 13.05,69, 2.Авторское свидетельство СССР по за вке №2514618/18-24,2. USSR Author's Certificate for Application No. 2514618 / 18-24, кл. В 25 J 13/00, 29,06,77 (прототип ) ,cl. B 25 J 13/00, 29,06,77 (prototype),