• Journal of Electrical Engineering and Technology
• /
• v.12 no.4
• /
• pp.1675-1682
• /
• 2017

This paper deals with three dimensional orientation estimation algorithm for an attitude and heading reference system (AHRS) based on nine-axis inertial/magnetic sensor signals. In terms of the orientation estimation based on the use of a Kalman filter (KF), the quaternion is arguably the most popular orientation representation. However, one critical drawback in the quaternion representation is that undesirable magnetic disturbances affect not only yaw estimation but also roll and pitch estimations. In this paper, a sequential direction cosine matrix-based orientation KF for AHRS has been presented. The proposed algorithm uses two linear KFs, consisting of an attitude KF followed by a heading KF. In the latter, the direction of the local magnetic field vector is projected onto the heading axis of the inertial frame by considering the dip angle, which can be determined after the attitude KF. Owing to the sequential KF structure, the effects of even extreme magnetic disturbances are limited to the roll and pitch estimations, without any additional decoupling process. This overcomes an inherent issue in quaternion-based estimation algorithms. Validation test results show that the proposed method outperforms other comparison methods in terms of the yaw estimation accuracy during perturbations and in terms of the recovery speed.

• Proceedings of the Korean Society of Precision Engineering Conference
• /
• 1993.10a
• /
• pp.570-574
• /
• 1993

This paper proposes a new method of estimating the position and heading angle of a mobile robot moving on a flat surface. The proposed localization method utilizes two passive beacons and a single rotating ultrasonic sensor. The passive beacons consist of two cylinders with different diameters and reflect the ultrasonic pulses coming from the sonar sensor mounted on the mobile robot. The geometric parameter set of beacon is acquired from the sonar scan data obtained at a single mobile robot location using a new data processing algorithm. Form this parameter set, the position and heading angle of the mobile robot is determined directly. The performance and validity of the proposed method are evaluated using two beacons and a single sonar sensor attached at the pan-tilt device mounted on a mobile robot, named LCAR, in our laboratory.

• The Journal of Korea Robotics Society
• /
• v.5 no.4
• /
• pp.279-285
• /
• 2010

This paper presents the use of 3 axis accelerometer for getting the gait information including the number of gaits, stride and walking distance. Travel distance is usually calculated from the double integration of the accelerometer output with respect to time; however, the accumulated errors due to the drift are inevitable. The orientation change of the accelerometer also causes error because the gravity is added to the measured acceleration. Unless three axis orientations are completely identified, the accelerometer alone does not provide correct acceleration for estimating the travel distance. We proposed a way of minimizing the error due to the change of the orientation. Pedestrian localization is implemented with the heading angle and the travel distance. Heading angle is estimated from the rate gyro and the magnetic compass measurements. The performance of the localization is presented with experimental data.

• Journal of Institute of Control, Robotics and Systems
• /
• v.19 no.9
• /
• pp.760-767
• /
• 2013

In this paper, we developed a Manta-type AUV (Autonomous Underwater Vehicle) and analyzed its control performance as well as its dynamic characteristics underwater. The nonlinear motion of equations, which are expressed in terms of hydrodynamic coefficients obtained by various experiments, are used to simulate the motion of a Manta AUV underwater. We applied the sliding-mode theory to control the heading angle and depth of the vehicle, and confirmed the effectiveness of the control algorithm through simulations and sea-trials.

• IEMEK Journal of Embedded Systems and Applications
• /
• v.10 no.6
• /
• pp.373-379
• /
• 2015

A hybrid navigation system is implemented to apply for a mobile robot. The hybrid navigation system consists of an inertial navigation system and a global positioning system. The inertial navigation system quickly calculates the position and the attitude of the robot by integrating directional accelerations, angular speed, and heading angle from a strap-down inertial measurement unit, but the results are available for a short time since it tends to diverge quickly. Global positioning system delivers position, heading angle, and traveling speed stably, but it has large deviation with slow update. Therefore, a hybrid navigation system uses the result from an inertial navigation system and corrects the result with the help of the global positioning system where an indirect feedback Kalman filter is used. We implement and confirm the performance of the hybrid navigation system through driving a car attaching it.

• Proceedings of the Korean Society for Agricultural Machinery Conference
• /
• 2000.11b
• /
• pp.325-332
• /
• 2000

The objective of this research work is to develop an autonomous levee-weeding robot. In this paper, pathway control system for the robot is developed and simulated. A prototype autonomous vehicle for levee weeding is also developed and used in the actual test. The results obtained in this research work is summarized as follows; 1) The simulated typical time history of lateral displacements and heading angle of the vehicle in straight run shows that the vehicle tendency is always to achieve the target path from any of its deviated position and heading angle. 2) The test run on an asphalt surface by the prototype crawler-type vehicle is in good agreement with the simulation results.

• International Journal of Aeronautical and Space Sciences
• /
• v.7 no.1
• /
• pp.118-128
• /
• 2006

This paper deals with auto-landing guidance system design applicable to Smart UAV(Unmanned Aerial Vehicle). The proposed guidance law generates horizontal position, velocity and altitude commands in the longitudinal channel and heading angle command in the lateral channel to track a predetermined trajectory for automatic landing. The longitudinal guidance commands are derived from an approximated dynamic equations in vertical plane. These longitudinal guidance commands are appropriately distributed to each control input as the flight mode of Smart UAV is changed. The concept of VOR(VHF Omni-directional Range) guidance system is applied to generate the required heading angle commands to eliminate the lateral deviation from the desired trajectory. The performance of the proposed guidance system for Smart UAV is evaluated using the nonlinear simulation. Simulation results show that the proposed guidance system for auto- landing provides good tracking performance along the predetermined landing trajectory.

• Journal of Institute of Control, Robotics and Systems
• /
• v.11 no.4
• /
• pp.363-368
• /
• 2005

This paper proposes an LOS(line-of-sight) guidance system of a ship for path following. From the viewpoint of a control configuration, guidance is a special type of compensation algorithm that is placed in front of the controller to accomplish navigational objects. A guidance system generates a reference trajectory for trajectory tracking or path control and decides the desired velocity, position and heading angle. A control system executes commands based on a reliable guidance law during navigation. An LOS vector from the vessel to a point on the path between two way-points in straight-line navigation or a point among turning circle in turning navigation is selected, and then a heading angle is calculated to converge the desired path based on the LOS vector. The LOS guidance law is defined for the straight-line and the turning circle, respectively. The effectiveness of the suggested LOS guidance system is assured through computer simulation.

• Journal of Advanced Research in Ocean Engineering
• /
• v.2 no.4
• /
• pp.192-201
• /
• 2016

This study examined a PD controller and its application to automatic berthing control of an unmanned surface vehicle (USV). First, a nonlinear mathematical model was established for the maneuvering of the USV in the presence of environmental forces. A PD control algorithm was then applied to control the rudder and propeller during an automatic berthing process. The algorithm consisted of two parts, namely the forward velocity control and heading angle control. The control algorithm was designed based on longitudinal and yaw dynamic models of the USV. The desired heading angle was obtained using the "line of sight" method. Finally, computer simulations of automatic USV berthing were performed to verify the proposed controller subjected to the influence of disturbance forces. The results of the simulation revealed a good performance of the developed berthing control system.

• Journal of Hydrospace Technology
• /
• v.1 no.1
• /
• pp.75-88
• /
• 1995

Auto-Pilot System uses heading angle information via the position sensor and the rudder device to control the ship's direction. Most of the control logics are composed of the state estimation and control algorithms assuming that the measurement device and the actuator have no fault except the measurement noise. But such asumptions could bring the danger in real situation. For example, if the heading angle measuring device is out of order the control action based on those false position information could bring serious safety problem. In this study, the control system including improved method for processing the position information is applied to the Auto-Pilot System. To show the difference between general state estimator and F.D.F., BJDFs for the sensor and the actuator failure detection are designed and the performance are tested. And it is shown that bias error in sensor could be detected by state-augmented estimator. So the residual confined in the 2-dimension in the presence of the sensor failure could be unidirectional in output space and bias sensor error is much easier to be detected.