Lighthouse terminology and definitions

This page contains terminology and definitions for the lighthouse system to make it easier to understand and discuss algorithms and code. Our definitions probably do not match the ones used by other software packages, but we find these suitable for our setup.

Reference frames

There are a number of different reference frames (or coordinate systems) used.

Global reference frame

The global coordinate system is fixed in the room and shared by all parts of the system. This system is used for absolute position references in set points and the kalman estimator.

Crazyflie reference frame

The Crazyflie reference frame is defined with the X-axis pointing forward, the Y-axis pointing left when seen from behind and the Z-axis pointing upwards.

Base station reference frame

The base station coordinate system is defined as

  • X-axis pointing forward through the glass
  • Y-axis pointing right, when the base station is seen from the front.
  • Z-axis pointing up (away from the screw mount)

Base station reference frame

Rotor reference frame

There is one (LH2) or two rotors (LH1) in a base station. Each rotor is rotating around an axis of rotation, r\vec{r}. We define a coordinate system for the rotor where the Z-axis points along r\vec{r} and the X-axis is the same as the X-axis of the base station.

Rotor reference frame

The axis of rotation is defined such that when r\vec{r} is pointing towards you, the drum is spinning counterclockwise.

Geometry data

The geometry data (position pbs\vec{p_{bs}} and rotation matrix RbsR_{bs}) describes the pose of a base station in the global coordinate system such that a point qbs\vec{q_{bs}} in the base station reference frame is transformed to the global reference frame by q=pbs+Rbsqbs\vec{q} = \vec{p_{bs}} + R_{bs} \cdot \vec{q_{bs}}.

Rotors

In relation to the base station reference frame we have

System type rotor r\vec{r}
LH 1  horizontal sweep (left to right seen from the front) (0,0,1)(0, 0, 1)
LH 1 vertical sweep (down to up seen from the front) (0,1,0)(0, -1, 0)
LH 2  horizontal sweep (left to right seen from the front) (0,0,1)(0, 0, 1)

The coordinate systems for the horizontal LH1 rotor and the LH2 rotor are identical to the base station reference frame.

Rotation angle

Rotation angle α=0\alpha=0 is forward, along the X axis in the rotor (and base station) reference frame.

Rotor rotation angle

Note: In LH2 the two light planes are offset from each other on the rotor by 120 degrees, but this offset is compensated for in the decoding part of the firmware. For a sensor placed along the X-axis, the measured α=0\alpha = 0 for both light planes.

Light plane tilt

There is a lens on the rotor spreading light in the form of a plane, rotating with the rotor. In LH1 the plane is oriented along the axis of rotation, sweeping the room when the rotor spins, while LH2 has two light planes that are tilted by an angle ±t\pm t. tt is defined such that the plane is rotated counterclockwise with increasing tt, seen from the front of the base station (α=0\alpha = 0).

Rotor rotation angle

In the general form we have no tilt for the rotors of LH1, in LH2 the planes are tilted 30 degrees.

System type rotor / light plane tt
LH 1  horizontal sweep (left to right seen from the front) 0
LH 1 vertical sweep (down to up seen from the front) 0
LH 2  horizontal sweep, first light plane π6-\frac{\pi}{6}
LH 2  horizontal sweep, second light plane π6\frac{\pi}{6}