找回密码
 马上注册

QQ登录

只需一步,快速开始

查看: 5210|回复: 6

求教下用RobotC编写GYRO自平衡PID小车

[复制链接]
发表于 2015-2-24 22:39:50 | 显示全部楼层 |阅读模式
先说下我的情况,我的NXT只有一个HiTechnicGyro的陀螺仪

不过不是很明白怎么用陀螺仪,,陀螺仪测的是角速度??

然后就是PID的问题了
有个帖子说:电机角速度增量=KP*GYRO角速度增量+KI*GYRO角速度增量+KP*GYRO角速度增量,,,这对吗? 也没D啊
GYRO角速度增量:用SensorValue[gyro]这个函数就能获得,对吧?
但是怎么让电机输出角速度?用哪个函数?


如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
发表于 2015-2-24 23:38:43 | 显示全部楼层
HiTechnic官网上有自平衡小车的搭建图和程序,有nxc版本的程序可以下载。这是网址,自己找找吧。
http://www.hitechnic.com/models
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

发表于 2015-2-25 10:05:08 | 显示全部楼层
陀螺仪貌似是用来测角度的?
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

发表于 2015-2-25 23:25:06 | 显示全部楼层
先问robotc 试用版到期了,怎么处理的?
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

 楼主| 发表于 2015-2-27 17:35:33 | 显示全部楼层
pokemonjs 发表于 2015-2-25 10:05
陀螺仪貌似是用来测角度的?

真不是角度,用SensorValue输出的数据,,只有在角度变化期间有数值变化,,当机器人不动时,哪怕有角度倾斜,也没有数值变化
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

 楼主| 发表于 2015-2-27 17:45:34 | 显示全部楼层
barzz 发表于 2015-2-24 23:38
HiTechnic官网上有自平衡小车的搭建图和程序,有nxc版本的程序可以下载。这是网址,自己找找吧。
http://w ...

这是PID控制?
    // This is the main balancing equation
     power = (KGYROSPEED * gyroSpeed +               // Deg/Sec from Gyro sensor
              KGYROANGLE * gyroAngle) / ratioWheel + // Deg from integral of gyro
             KPOS       * motorPos +                 // From MotorRotaionCount of both motors
             KDRIVE     * motorControlDrive +        // To improve start/stop performance
             KSPEED     * motorSpeed;                // Motor speed in Deg/Sec
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

 楼主| 发表于 2015-2-27 23:23:35 | 显示全部楼层
alex_cn 发表于 2015-2-25 23:25
先问robotc 试用版到期了,怎么处理的?

按的x3,可以破解,
x4的话无解
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 马上注册

本版积分规则

手机版|中文乐高 ( 桂ICP备13001575号-7 )

GMT+8, 2025-6-26 18:20 , Processed in 0.207731 second(s), 24 queries .

Powered by Discuz! X3.5

Copyright © 2001-2020, Tencent Cloud.

快速回复 返回顶部 返回列表