6-DOF Control

6-DOF Control (Six Degrees of Freedom) refers to the control of a rigid body’s position and orientation in 3D space. The six degrees are:

  • 3 translational: X, Y, Z (forward/back, left/right, up/down)
  • 3 rotational: Roll, Pitch, Yaw (rotation about X, Y, Z axes)

In Aerospace

A spacecraft or aircraft with 6-DOF can control its complete state in space. Most vehicles are underactuated (fewer actuators than DOF) or overactuated (more actuators than DOF).

In AEGIS

AEGIS maps a desired 6-DOF wrench (3 forces + 3 torques) to engine throttles and gimbal angles:

wrench = [Fx, Fy, Fz, τx, τy, τz]

Control Allocation Problem

Given a desired wrench τ_desired, find actuator commands u such that:

τ_desired = B * u

Where B is the control effectiveness matrix. When B is not square ( fewer actuators than DOF), a pseudo-inverse is used:

u = pinv(B) * τ_desired

Reference Frames

FrameDescriptionAxes
BodyFixed to vehicleX-forward, Y-right, Z-down
InertialFixed to planetECEF coordinates
NEDLocal tangent planeX-north, Y-east, Z-down

Sources

  • AEGIS Project (src/guidance/allocator.py)