Figure 2:
The mathematical model of vision tracking measurement system and the transformation relationship between coordinate systems.