Method and system for universal guidance and control of automated machines

摘要

A system for universal guidance and control of automated machines incorporates with an IMU (Initial Measuring Unit) installed at an end effector of a motion element of an automated machine, fast-response feedback control for both position and angle servo-loops (for the end effector) greatly decreases the operational time needed to complete a preplanned trajectory. In addition, the closed-control loop design provides stabilization and isolation of the end effector from external disturbances. This unique navigation solution is based upon the uses of a set of equations performing an open loop computation with the inertial data as its input. This formulation of equations requires a periodic update of the open loop solution in order to bind the growth of system errors. The source of this update is the automated machine position measurement derived from the mechanical sensors in the system.