This paper presents algorithms implemented for positioning a wheeled robot on a production floor inside a factory by means of radio-frequency distance measurement and trilateration techniques. A set of radio-frequency transceivers located on the columns of the factory (anchors) create a grid with several triangular zones capable of measuring the line-of-sight distance between each anchor and the transceiver installed in the wheeled robot. After measuring only three of these distances (radii), an enhanced trilateration algorithm is applied to obtain X and Y coordinates in a Cartesian plane, i.e., the position of the robot on the factory floor. The embedded systems developed for the anchors and the robot are robust enough to establish communication, select the closest anchors for measuring radii, and identify in which of the grid zones the robot is located.

This paper presents balancing, velocity and motion control of a self-balancing vehicle. A cascade controller is implemented for both balancing control and angular velocity control. This controller is tested in simulations using a proposed mathematical model of the system. Motion control is achieved based on the kinematics of the robot. Control hardware is designed and integrated to implement the proposed controllers. Pitch is kept under 1° from the equilibrium position with no external disturbances. The linear cascade control is able to handle slight changes in the system dynamics, such as in the centre of mass and the slope on an inclined surface.