|
|
发表于 2013-9-2 08:31:08
|
显示全部楼层
本帖最后由 leicheng 于 2014-1-19 18:53 编辑
看了下,实现了2自由度的旋转。
从绘制小长方体函数可以看出void drawCube()
{
pushMatrix();
translate(300, 450, 0);
scale(4, 4, 4);
rotateX(HALF_PI * -RwEst[0]); rotateZ(HALF_PI * RwEst[1]);
buildBoxShape();
popMatrix();
}
旋转变换,即rotateX和rotateZ。X轴和Z轴的转动角度读取比较正常,然而Y轴的值无法进行读取,这牵涉到一个正向定位的问题,加入磁力计可以解决。
此外,arduino部分的函数存在漏洞,程序运行不了多久会产生内存方面的问题。 |
|