【超小型 Linux 开发套件Quantum Tiny Linux】基于tinygl+mpu6050的3D角度计Demo

qinyunti 发表于 2024-7-20 16:25

<div class='showpostmsg'>源码见附件

<div></div>

 

视频

8a7af6ceb374849fac8ec8c30f65f96c 
b站视频

<iframe allowfullscreen="true" frameborder="0" height="450" src="//player.bilibili.com/player.html?bvid=1YR8Te5EFi&page=1" style="background:#eee;margin-bottom:10px;" width="700"></iframe> 
视频号

<a href="https://mp.weixin.qq.com/s/AWBqpGxUXcHKvcQ7Vc7kig">基于tinygl+mpu6050的3D角度计Demo (qq.com)</a>

 

前面我们移植了tinygl可以进行3D显示了，结合之前获取的mpu6050的角度信息，我们就可以3D动态显示角度的变化过程。实现水准(角度计)的Demo。

 

 

角度显示

        char text;

        /* 获取角度 */

        int16_t accel;

        mpu6050_itf_get_accel(accel);

        accel /= 4096;

        accel /= 4096;

        accel /= 4096;

        /* 加速度计算角度

        θx=α1180/π=180/π

        θy=β1180/π=180/π

        θz=γ1180/π=*180/π

        */

        float th;

        th = atan2(sqrt(accel*accel+accel*accel),accel) * 180/PI;

        th = atan2(sqrt(accel*accel+accel*accel),accel) * 180/PI;

        th = atan2(sqrt(accel*accel+accel*accel),accel) * 180/PI;

       

        glClear(GL_COLOR_BUFFER_BIT | GL_DEPTH_BUFFER_BIT);

 

        /* 显示角度 */

        snprintf(text,sizeof(text),"x:%f",th);

        glDrawText((GLubyte *)text, 0, 0, 0xFF0000);

        snprintf(text,sizeof(text),"y:%f",th);

        glDrawText((GLubyte *)text, 0, 12, 0x00FF00);

        snprintf(text,sizeof(text),"z:%f",th);

        glDrawText((GLubyte *)text, 0, 24, 0x0000FF);

 

 

 

显示立方体，立方体绕三轴旋转来动态展示，三轴的角度

 

        /* 画立方体，并旋转角度 */

        draw_cube(th, th, th, 2, winSizeX, winSizeY);

 

void draw_cube(float x, float y, float z, float size, float cx, float cy)

{                      

    glRotatef(x, 1.0f, 0.0f, 0.0f);

    glRotatef(y, 0.0f, 1.0f, 0.0f);

    glRotatef(z, 0.0f, 0.0f, 1.0f);

 

    glBegin(GL_QUADS);

 

    // Front Face

    glColor3f(1.0f, 0.0f, 0.0f);        //红

    glVertex3f(-size, -size, size);

    glVertex3f(size, -size, size);

    glVertex3f(size, size, size);

    glVertex3f(-size, size, size);

 

    // Back Face

    glColor3f(1.0f, 1.0f, 0.0f);    //黄

    glVertex3f(-size, -size, -size);

    glVertex3f(size, -size, -size);

    glVertex3f(size, size, -size);

    glVertex3f(-size, size, -size);

 

    // Top Face

    glColor3f(0.0f, 0.0f, 1.0f);        //蓝

    glVertex3f(-size, size, size);

    glVertex3f(size, size, size);

    glVertex3f(size, size, -size);

    glVertex3f(-size, size, -size);

 

    // Bottom Face

    glColor3f(1.0f, 0.0f, 1.0f);    //紫

    glVertex3f(-size, -size, size);

    glVertex3f(size, -size, size);

    glVertex3f(size, -size, -size);

    glVertex3f(-size, -size, -size);

 

    // Left Face

    glColor3f(0.0f, 1.0f, 0.0f);        //绿

    glVertex3f(-size, -size, -size);

    glVertex3f(-size, -size, size);

    glVertex3f(-size, size, size);

    glVertex3f(-size, size, -size);

 

    // Right face

    glColor3f(0.0f, 1.0f, 1.0f);    //青

    glVertex3f(size, -size, size);

    glVertex3f(size, -size, -size);

    glVertex3f(size, size, -size);

    glVertex3f(size, size, size);

    glEnd();

}

 

完整的代码见附件。

 

编译

gcc tinygl/src/*.c cube.c lcd.c mpu6050.c mpu6050_itf.c -I tinygl/include/ -o cube -lm

 

运行

./cube

 

测试效果见视频
</div><script> var loginstr = '<div class="locked">查看本帖全部内容，请<a href="javascript:;" style="color:#e60000" class="loginf">登录</a>或者<a href="https://bbs.eeworld.com.cn/member.php?mod=register_eeworld.php&action=wechat" style="color:#e60000" target="_blank">注册</a></div>';

if(parseInt(discuz_uid)==0){
(function($){
var postHeight = getTextHeight(400);
$(".showpostmsg").html($(".showpostmsg").html());
$(".showpostmsg").after(loginstr);
$(".showpostmsg").css({height:postHeight,overflow:"hidden"});
})(jQuery);
} </script><script type="text/javascript">(function(d,c){var a=d.createElement("script"),m=d.getElementsByTagName("script"),eewurl="//counter.eeworld.com.cn/pv/count/";a.src=eewurl+c;m.parentNode.insertBefore(a,m)})(document,523)</script>

页: [1]

电子工程世界-论坛's Archiver

【超小型 Linux 开发套件Quantum Tiny Linux】基于tinygl+mpu6050的3D角度计Demo