我正在运行linux的FPGA板上开发视频游戏。我想用wiimote来控制游戏。现在我有一个传感器杆，两端有多个红外线源，还有一个wiimote。我想根据从红外摄像机读入的红外光源的位置数据来跟踪wiimote在太空中的位置。我已经搜索了算法来进行定位，但无法找到详细的算法。我也想知道是否有一些已经实现了定位算法的读取使用库，这样我就不需要自己动手了。
目前我正在用libwiimote库操作wiimote。我可以从红外摄像机获得最多四个红外光源位置。如何根据这些数据计算wiimote的位置？谢谢！