• 제목/요약/키워드: a forward kinematics

검색결과 147건 처리시간 0.032초

정렬오차 추정 필터에 기반한 비전 정렬 시스템의 고속 정밀제어 (Fast and Fine Control of a Visual Alignment Systems Based on the Misalignment Estimation Filter)

  • 정해민;황재웅;권상주
    • 제어로봇시스템학회논문지
    • /
    • 제16권12호
    • /
    • pp.1233-1240
    • /
    • 2010
  • In the flat panel display and semiconductor industries, the visual alignment system is considered as a core technology which determines the productivity of a manufacturing line. It consists of the vision system to extract the centroids of alignment marks and the stage control system to compensate the alignment error. In this paper, we develop a Kalman filter algorithm to estimate the alignment mark postures and propose a coarse-fine alignment control method which utilizes both original fine images and reduced coarse ones in the visual feedback. The error compensation trajectory for the distributed joint servos of the alignment stage is generated in terms of the inverse kinematic solution for the misalignment in task space. In constructing the estimation algorithm, the equation of motion for the alignment marks is given by using the forward kinematics of alignment stage. Secondly, the measurements for the alignment mark centroids are obtained from the reduced images by applying the geometric template matching. As a result, the proposed Kalman filter based coarse-fine alignment control method enables a considerable reduction of alignment time.

지면에 고정되어 있지 않은 여유자유도 매니플래이터의 운동계획 알고리즘 (Motion Planning Algorithms for Kinematically Redundant Manipulator Not Fixed to the Ground)

  • 유동수;소병록;김희국
    • 제어로봇시스템학회논문지
    • /
    • 제10권10호
    • /
    • pp.869-877
    • /
    • 2004
  • This paper deals with motion planning algorithm for kinematically redundant manipulators that are not fixed to the ground. Differently from usual redundant manipulators fixed to the ground, the stability issue should be taken into account to prevent the robot from falling down. The typical ZMP equation, which is employed in human walking, will be employed to evaluate the stability. This work proposes a feed forward ZMP planning algorithm. The algorithm embeds the 'ZMP equations' indirectly into the kinematics of the kinematic model of a manipulator via a ZMP stability index The kinematic self motion of the redundant manipulator drives the system in such a way to keep or plan the ZHP at the desired position of the footprint. A sequential redundancy resolution algorithm exploiting the remaining kinematic redundancy is also proposed to enhance the performances of joint limit index and manipulability. In addition, the case exerted by external forces is taken into account. Through simulation for a 5 DOF redundant robot model, feasibility of the proposed algorithms is verified. Lastly, usual applications of the proposed kinematic model are discussed.

중재 시술 적용을 위한 소형 연속체 로봇의 정역학 모델링 및 외부 측면 하중에 의한 변위 분석 (Static Modeling of a Miniaturized Continuum Robot for Surgical Interventions and Displacement Analysis under Lateral External Loads)

  • 김기영;우현수;조장호;신민기;서정욱
    • 로봇학회논문지
    • /
    • 제15권4호
    • /
    • pp.301-308
    • /
    • 2020
  • In this paper, we deal with the static modeling of a continuum robot that can perform surgical interventions. The proposed continuum robot is made of stainless steel wires and a multi lumen flexible tube using a thermoplastic elastomer. This continuum robot could be most severely deformed in physical contact with narrow external environments, when a lateral external force acts at the distal tip of the continuum robot. In order to predict the shape and displacement under the lateral external force loading, the forward kinematics, the statics modeling, the force-moment equilibrium equation, and the virtual work-energy method of the continuum robot are described. The deflection displacements were calculated using the virtual work-energy method, and the results were compared with the displacement obtained by the conventional cantilever beam theories. In conclusion, the proposed static modeling and the virtual work-energy method can be used in arrhythmia procedure simulations.

Wearable Robot Arm의 제작 및 제어 (Design and Control of a Wearable Robot)

  • 정연구;김윤경;김경환;박종오
    • 대한기계학회:학술대회논문집
    • /
    • 대한기계학회 2001년도 춘계학술대회논문집B
    • /
    • pp.277-282
    • /
    • 2001
  • As human-friendly robot techniques improve, the concept of the wearability of robotic arms becomes important. A master arm that detects human arm motion and provides virtual forces to the operator is an embodied concept of a wearable robotic arm. In this study, we design a 7 DOF wearable robotic arm with high joint torques. An operator wearing this robotic arm can move around freely because this robotic arm was designed to have its fixed point at the shoulder part of the operator. The proposed robotic arm uses parallel mechanisms at the shoulder part and the wrist part on the model of the human muscular structure of an upper limb. To reduce the computational load in solving the forward kinematics and to prevent singularity motions of the parallel mechanism, yawing motion of the parallel mechanisms was separated using a slip ling mechanism. The total weight of the proposed robotic arm is about 4 kg. An experimental result of force tracking test for the pneumatic control system and an application example for VR robot are described to show the validity of the robot.

  • PDF

VCM을 이용한 노광기용 정밀 레티클 스테이지의 저진동 제어시스템 개발 (Design of the Low Hunting Controller for the Reticle Stage for Lithography)

  • 김문수;오민택;김정한
    • 한국공작기계학회논문집
    • /
    • 제17권4호
    • /
    • pp.51-58
    • /
    • 2008
  • This paper presents a new design of the precision stage for the reticle in lithography process and a low hunting control method for the stage. The stage has three axes for X, Y, ${\theta}_z$ those actuated by three voice coil motors individually. The designed reticle stage system has three gap sensors and voice coil motors, and supported by four air bearings and the forward/inverse kinematics of the stage were solved to get an accurate reference position. When a stage is in regulating control mode, there always exist small fluctuations(stage hunting) in the stage movement. Because the low stage hunting characteristic is very important in recent lithography and nano-level applications, a special regulating controller for ultra low hunting is proposed in this paper. Also this research proposed the 2-step transmission system for preventing the noise infection from environmental devices. The experimental results showed the proposed regulating control system reduced hunting noise as 35nm(rms) when a conventional PID generates 77nm(rms) in the same mechanical system. Besides the reticle stage has 100nm linear accuracy and $1{\mu}rad$ rotation accuracy at the control frequency of 8kHz.

마이크로포지셔닝 병렬평행기구의 개발 및 실험 (Development and Experiment of a Micropositioning Parallel Manipulator)

  • 차영엽;윤권하
    • 제어로봇시스템학회논문지
    • /
    • 제15권5호
    • /
    • pp.543-547
    • /
    • 2009
  • This paper describes the design, simulation, development, and experiment of a six degree-of-freedom micropositioning parallel manipulator. A movable stage was supported with six links, each of which extends with a dc-servo micropositioning actuator. In case of parallel manipulator, while the solution of the inverse kinematics is easily found by the vectors of the links which are composed of the joint coordinates in base and platform, but forward kinematic is not easily solved because of the nonlinearity and complexity of the parallel manipulator's kinematic output equation with the multi-solutions. The movable range of the prototype was ${\pm}25mm$ in the x- and y-directions and ${\pm}12.5mm$ in the z-direction. The minimum incremental motion of the prototype was $1{\mu}m$ in the x- and y-directions and $0.5{\mu}m$ in the z-direction. The repeatability of the prototype was ${\pm}2{\mu}m$ in the x- and y-directions and ${\pm}1{\mu}m$ in the z-direction. The motion performance was also evaluated by not only the computer simulation of CAD model but also the experiment using a capacitive sensor system.

병렬구조형 차량운전 모사장치의 성능평가 및 분석 (Analysis and performance evaluation of the parallel typed for a vehicle driving simulator)

  • 박일경;박경균;김정하;이운성
    • 제어로봇시스템학회:학술대회논문집
    • /
    • 제어로봇시스템학회 1997년도 한국자동제어학술회의논문집; 한국전력공사 서울연수원; 17-18 Oct. 1997
    • /
    • pp.1481-1484
    • /
    • 1997
  • The vehicle driving simulator expects vehicle motion with real-time simulation arise from driver's steering, accelerating, stopping and simulates motion of vehicl with visula, audio and washout algorithm. And it gives a vivid feeling to driver in reality. Vehicle driving simulator with vehicle integration control system is used for analysis of analysis of vehicle controllaility, steering capacity and safety in various pseudo environment alike. basides, it analyzeds vehicle safety factor dirver's reaction and promotes traffic safety without driver's own risks. The main proceduress of development of the vehicle driving simulator are classified by 3 parts. first the motion base system which can be generated by the motion queues, should be developed. Secondly, real-time vehicle software which can afford the vehicle dynamics, might be constructed. The third procedure is the integration of vehicle driing simulator which can be interconnected between visual systems with motion base. In this study, we are to study of the motion base for a vehicle driving simulator design and that of its real time control and using an extra gyro sensor and accelerometers to find a position and an orientatiion of the moving platform except for calculating forward kinematics. To drive the motion base, we use National Instruments corp's Labview software. Furthemore, we use analysis module for the vehicle motionand the washout algorithm module to consummate driving simulator, which can be driven by human in reality, so we are doing experimentally process about various vehicle motion conditon.

  • PDF

수직다관절형 아암의 운동학적 모델링 및 관절공간 모션제어에 관한 연구 (A Study on Kinematics Modeling and Motion Control Algorithm Development in Joint for Vertical Type Articulated Robot Arma)

  • 조상영;김민성;양준석;원종범;한성현
    • 한국산업융합학회 논문집
    • /
    • 제19권1호
    • /
    • pp.18-30
    • /
    • 2016
  • In this paper, we propose a new technique to the design and real-time control of an adaptive controller for robotic manipulator based on digital signal processors. The Texas Instruments DSPs(TMS320C80) chips are used in implementing real-time adaptive control algorithms to provide enhanced motion control performance for dual-arm robotic manipulators. In the proposed scheme, adaptation laws are derived from model reference adaptive control principle based on the improved Lyapunov second method. The proposed adaptive controller consists of an adaptive feed-forward and feedback controller and time-varying auxiliary controller elements. The proposed control scheme is simple in structure, fast in computation, and suitable for real-time control. Moreover, this scheme does not require any accurate dynamic modeling, nor values of manipulator parameters and payload. Performance of the proposed adaptive controller is illustrated by simulation and experimental results for a dual arm robot manipulator with eight joints. joint space and cartesian space.

2자유도 승마로봇 제어를 위한 동작특성분석 (Motion analysis for control of a 2-DOF horse riding robot)

  • 서동진;전세웅;김영욱;고낙용
    • 로봇학회논문지
    • /
    • 제6권3호
    • /
    • pp.263-273
    • /
    • 2011
  • This paper analyzes the motion of a horseback riding robot which has two actuators and three joints. It is impossible to control the saddle to get to any position and orientation using the two motors because the robot has less degrees of freedom than the number of joints. Therefore it is required to know the possible location and orientation along with the velocity characteristics of each pose prior to motion planning. For this purpose, this paper analyzes the characteristics of the robot motion. The authors derive the forward and inverse kinematics of the robot motion and developed the trajectory editor for motion planning. Also, Jacobian of the robot is analyzed. It reveals that one of the actuator has little influence to the speed of the saddle motion while the other affects the speed of the saddle motion dominantly. The approach of the paper can be applied for the analysis of characteristics of a robot which has less number of actuators than that of joints.

Determination of Identifiable Parameters and Selection of Optimum Postures for Calibrating Hexa Slide Manipulators

  • Park, Jong-Hyuck;Kim, Sung-Gaun;Rauf, Abdul;Ryu, Je-Ha
    • 제어로봇시스템학회:학술대회논문집
    • /
    • 제어로봇시스템학회 2003년도 ICCAS
    • /
    • pp.2737-2742
    • /
    • 2003
  • Kinematic calibration enhances absolute accuracy by compensating for the fabrication tolerances and installation errors. Effectiveness of calibration procedures depends greatly on the measurements performed. While the Cartesian postures are measured completely, all of the geometric parameters can be identified to their true values. With partial pose measurements, however, few geometric parameters may not be identifiable and effectiveness of the calibration results may vary significantly within the workspace. QR decomposition of the identification Jacobian matrix can reveal the non-identifiable parameters. Selecting postures for measurement is also an important issue for efficient calibration procedure. Typically, the condition number of the identification Jacobian is minimized to find optimum postures. This paper investigates identifiable parameters and optimum postures for four different calibration procedures - measuring postures completely with inverse kinematic residuals, measuring postures completely with forward kinematics residuals, measuring only the three position components, and restraining the mobility of the end-effector using a constraint link. The study is performed for a six degree-of-freedom fully parallel HexaSlide type paralle manipulator, HSM. Results verify that all parameters are identifiable with complete posture measurements. For the case of position measurements, one and for the case of constraint link, three parameters were found non-identifiable. Optimal postures showed the same trend of orienting themselves on the boundaries of the search space.

  • PDF