• Title/Summary/Keyword: kinematic constraint equation

Search Result 35, Processing Time 0.029 seconds

Maneuvering Target Tracking With 3D Variable Turn Model and Kinematic Constraint (3D 가변 선회 모델 및 기구학적 구속조건을 사용한 기동표적 추적)

  • Kim, Lamsu;Lee, Dongwoo;Bang, Hyochoong
    • Journal of the Korean Society for Aeronautical & Space Sciences
    • /
    • v.48 no.11
    • /
    • pp.881-888
    • /
    • 2020
  • In this paper, research on estimation of states of a target of interest using Line Of Sight(LOS) angle measurement is performed. Target's position, velocity, and acceleration are chosen to be the states of interests. The LOS measurement is known to be highly non-linear, making target dynamic modeling hard to be implemented into a filter. To solve this issue, the Pseudomeasurement equation was applied to the LOS measurement equation. With the help of this equation, 3D variable turn target dynamic model is applied to the filter model. For better performance, Kinematic Constraint is also implemented into the filter model. As for the filter, Bias Compensation Pseudomeasurement Filter (BCPMF) is used which is known for its robustness to initial conditions. Moreover, Two-Stage Kalman Filter (TSKF) form was also implemented to benefit from the parallel computation. As a result, TBCPMF 3DVT-KC is proposed and simulated to assess performance.

New Direct Kinematic Formulation of 6 D.O.F Stewart-Cough Platforms Using the Tetrahedron Approach

  • Song, Se-Kyong;Kwon, Dong-Soo
    • Transactions on Control, Automation and Systems Engineering
    • /
    • v.4 no.3
    • /
    • pp.217-223
    • /
    • 2002
  • The paper presents a single constraint equation of the direct kinematic solution of 6-dof (Stewart-Gough) platforms. Many research works have presented a single polynomial of the direct kinematics for several 6-dof platforms. However, the formulation of the polynomial has potential problems such as complicated formulation procedures and discrimination of the actual solution from all roots. This results in heavy computational burden and time-consuming task. Thus, to overcome these problems, we use a new formulation approach, called the Tetrahedron Approach, to easily derive a single constraint equation, not a polynomial one, of the direct kinematics and use two well-known numerical iterative methods to find the solution of the single constraint equation. Their performance and characteristics are investigated through a series of simulation.

A Formulation of the Differential Equation on the Equations of Motion and Dynamic Analysis for the Constrained Multibody Systems (구속된 다물체 시스템에 대한 운동 방정식의 미분 방정식화 및 동역학 해석)

  • 이동찬;이상호;한창수
    • Transactions of the Korean Society of Automotive Engineers
    • /
    • v.5 no.1
    • /
    • pp.154-161
    • /
    • 1997
  • This paper presents the method to eliminate the constraint reaction in the Lagrange multiplier form equation of motion by using a generalized coordinate driveder from the velocity constraint equation. This method introduces a matrix method by considering the m dimensional space spanned by the rows of the constraint jacobian matrix. The orthogonal vectors defining the constraint manifold are projected to null vectors by the tangential vectors defined on the constraint manifold. Therefore the orthogonal projection matrix is defined by the tangential vectors. For correcting the generalized position coordinate, the optimization problem is formulated. And this correction process is analyzed by the quasi Newton method. Finally this method is verified through 3 dimensional vehicle model.

  • PDF

Power-flow Independent Modeling of Vehicle Powertrain (Power-flow에 독립적인 파워트레인 모델링)

  • 최기영;이승종
    • Proceedings of the Korean Society of Precision Engineering Conference
    • /
    • 2001.04a
    • /
    • pp.267-270
    • /
    • 2001
  • A lot of efforts have been made to analyze the performance of the vehicle equipped with automatic transmission through simulation. It might be necessary to understand the different types of transmissions, i.e., different power flows, for different models. If there is a module that can be applied to different types of automatic transmission, it could be helpful to transmission-related engineers. This study has started up from this idea. The common bond graph has been obtained from several types of the automatic transmission. The overall generalized equations and kinematic constraint equations have been derived using virtual power sources on common bond graph. They are used to derive state equations and constraints. These equations have been applied as an application to the vehicle equipped with two simple planetary gear set type of Ravigneaux gear type automatic transmission. The state equation, kinematic constraints, and dynamic constraints have been derived in every gear and shift operation using overall generalized equations and kinematic constraint equations. Simulations for constraint speed running, standing-start running, rolling-start running, and LA-4 mode have been conducted to analyze the performance of the vehicle powertrain using GVPS(Generalized Vehicle Powertrain Simulation) program wit pull down menus.

  • PDF

A Gemetric Kinematic Analysis of Constrained Multibody System (구속된 다물체 시스템을 위한 기하학적 운동구속론)

  • 김재용;배대성;한창수;이상호
    • Transactions of the Korean Society of Automotive Engineers
    • /
    • v.2 no.4
    • /
    • pp.80-90
    • /
    • 1994
  • Basic constraint equations derived from orthogonality conditions between a pair of body-fixed vectors and a body-fixed vector or a vector between two bodies are reformulated by using relative coordinate kinematics between two adjacent reference frames. Arithmetic numbers of operations required to compute derivatives of the constraint equations are drastically reduced. A mixed formulation of relative and cartesian coordinates is developed to further simplify derivatives of the constraints. Advantages and disadvantages of the new formulation are discussed. Possible singularity problem of para llelism constraints is resolved by introducing an extra generalized coordinate. Kinematic analysis of a McPherson strut suspension system are carried out to illustrate use and efficiency of the new formulation.

  • PDF

Constraint-Combined Adaptive Complementary Filter for Accurate Yaw Estimation in Magnetically Disturbed Environments

  • Jung, Woo Chang;Lee, Jung Keun
    • Journal of Sensor Science and Technology
    • /
    • v.28 no.2
    • /
    • pp.81-87
    • /
    • 2019
  • One of the major issues in inertial and magnetic measurement unit (IMMU)-based 3D orientation estimation is compensation for magnetic disturbances in magnetometer signals, as the magnetic disturbance is a major cause of inaccurate yaw estimation. In the proposed approach, a kinematic constraint is used to provide a measurement equation in addition to the accelerometer and magnetometer signals to mitigate the disturbance effect on the orientation estimation. Although a Kalman filter (KF) is the most popular framework for IMMU-based orientation estimation, a complementary filter (CF) has its own advantages over KF in terms of mathematical simplicity and ease of implementation. Accordingly, this paper introduces a quaternion-based CF with a constraint-combined correction equation. Furthermore, the weight of the constraint relative to the magnetometer signal is adjusted to adapt to magnetic environments to optimally deal with the magnetic disturbance. In the results of our validation experiments, the average and maximum of yaw errors were $1.17^{\circ}$ and $1.65^{\circ}$ from the proposed CF, respectively, and $8.88^{\circ}$ and $14.73^{\circ}$ from the conventional CF, respectively, showing the superiority of the proposed approach.

Motion Planning of Manipulators Using Kinematic Redundancy and ZMP Constraint Condition (기구학적 여유도와 ZMP 구속 조건을 이용한 매니퓰레이터의 동작 계획)

  • Choi, Jae-Yeon;Yoon, Hyun-Soo;Yi, Byung-Ju
    • The Journal of Korea Robotics Society
    • /
    • v.6 no.4
    • /
    • pp.308-316
    • /
    • 2011
  • This work deals with development of effective redundancy resolution algorithms for the motion control of manipulator. Differently from the typical kinematically redundant robots that are attached to the fixed ground, the ZMP condition should be taken into account in the manipulator motion in order to guarantee the system stability. In this paper, a new motion planning algorithm for redundant manipulator not fixed to the ground is introduced. A sequential redundancy resolution algorithm is proposed, which ensures the ZMP (Zero Moment Point) stability, the planned operational motion, and additional sub-criteria such as joint limit index. A geometric constraint equation derived by reshaping the existing ZMP equation enables one to employ the sequential redundancy algorithm. The feasibility of the proposed algorithm is verified by simulating a redundant manipulator model.

Approximate Synthesis of 5-SS Multi Link Suspension System (근사 합성법을 이용한 5-SS 멀티 링크 현가장치의 기구학적 설계)

  • 김선평;심재경;안병의;이언구
    • Transactions of the Korean Society of Mechanical Engineers A
    • /
    • v.24 no.11
    • /
    • pp.2665-2671
    • /
    • 2000
  • Dimensional Synthesis, which is apart of kinematic synthesis, is to determine the dimensions of a mechanism of preconceived typer for a specified task and prescribed performance. In this paper, in an effort to provide designers with flexibility, a dimensional approximate synthesis method is presented for utilizing prescribed tolerance both the displacement and joint positions of a mechanism to be synthesized. For this, a constrained optimization problem is formulated with displacement parameters and joint positions as variables. The proposed method is applied to the synthesis of a 5-SS multi link suspension mechanism. The method discussed here, however, can be easily applied to any mechanism of which the kinematic constraint equations can be derived.

Inverse Kinematics of a Serial Manipulator : Redundancy and a Closed-rom Solution by Exploting Geomertiric Constraints (원료불출기의 역기구학 : 여유자유도와 구속조건을 이용한 닫힌 형태의 해)

  • 홍금식;김영민;최진태;신기태;염영일
    • Proceedings of the Korean Society of Precision Engineering Conference
    • /
    • 1996.04a
    • /
    • pp.661-665
    • /
    • 1996
  • An inverse kinemetics problem of a reclaimer which digs and transports ironstones or coals in the raw yard is investigated. Because of the special features of the reclaimer of which scooping buckets are attached around the rotating drum at the end of boom, kinematic redundancy occurs in determining the joint varialbes For a given reclaiming point in space the forward kinematics yields 3 equations, however the number of involved variables in the equations are four. A plane equation approximating the surface near a reclaiming point is obtained by considering 8 adjacent points surrounding the reclaiming point. One extra equation to overcome redunduncyis further obtained from the condition that the normal vector at a reclaiming point is perpendicular to the plane. An approximate solution for a simplified problem is first discussed, Numerical solution for the oritinal nonlinear porblem with a constraint equation is also investigated. Finally a closed form solution which is not exact but sufficiently close enough is proposed by exploiting geometric constraint.

  • PDF

A study on Hamilton motion equation of independent generalized coordinates for wheeled vehicle (독립 일반화 좌표에 의한 차륜 차량의 Hamilton 운동 방정식에 관한 연구)

  • 양성모;배대성;원용석
    • Journal of the korean Society of Automotive Engineers
    • /
    • v.14 no.3
    • /
    • pp.43-56
    • /
    • 1992
  • This task is to derive the Hamiltonian equations of motion for BMW 323i vehicle. The kinematic relationships are defined. The cut constraint equations are derived. The cut constraint equations are stabilized. The stabilized constraint equations are used to derive the relationships between the independent and dependent coordinates. The Hamiltonian equations of motion are reduced only in terms of the independent generalized coordinates.

  • PDF