大二时做的小机器人，和大家分享下（有视频，高手勿喷）

加载中

鼓励

加载中...

文号t41783

4991

大二时做的小机器人，和大家分享下（有视频，高手勿喷）

zuiyiyunyan2012/03/12机械与工具 IP:江苏

先上视频吧点击此处查看视频
全身黑色衣服那个是我！[s:274]
整个系统很简单，处理器是51系列的stc12c5a60s2，硬件2路pwm。8位红外对管的循迹板（也有16位的光敏的循迹板），L298驱动电机，机械臂部分不是我负责的，放球那位仁兄负责的。4个按键，2位数码管（595驱动的）等等，其他想到了再说，本人能力有限，发此贴就是为了转正啊！
好不容易找到了以前写的一些代码，贴一点核心的部分，整体的代码有1-2千行，编译成.hex有13k，还好这单片机能装。
循迹是采用PID算法的，只是数学没学好，只用了其中的P，I和D没有用，就是所谓简单的一次多项式模型：y = kx + A，我也怕cpu算不过来啊！代码如下：
8位传感器的：
void xunji()
{
     uchar sensorData,i,sum,temp;
     float bias=0;
     char zkb1,zkb2;
     int zkba,zkbb;
     static unsigned char flagSensor[8] = {0};      用一个数组来记录sensorData中的每一个位
     sensorData=P0;            读传感器
     for(i=0; i<8; i++)
    {
        flagSensor = sensorData & 0x01;
        sensorData >>= 1;
    }
    sum = 0;
    for(i=0; i<8; i++)
        if(flagSensor) sum ++;      计算线上的传感器个数（假设在黑线上传感器返回1）

    temp = 0;
    for(i=0; i<8; i++)
    {
        if(flagSensor)
            temp += (i+1);    计算在线上的传感器编号之和
    }
    if(temp != 0) bias = temp*1.0 / sum - REF_VALUE;    一次多项式模型：y = kx + A       REF_VALUE为4.5，具体自己算（1+8）/2

    zkba=(int)(90*bias)+120;     90和120 都是经验值
    zkbb=(int)(-90*bias)+120;

//     zkba=(int)(180*bias)+255;    90和120太慢了，这个参数跑的快，嘿嘿！
//    zkbb=(int)(-180*bias)+255;


    if(zkba>255)    zkb  占空比   代码写的不专业，乱起名字！
     zkba=255;
    if(zkba<-255)
      zkba=-255;
    zkb1=abs(zkba);
    CCAP0H = zkb1;          单片机的寄存器，具体看stc12c5a60s2芯片手册，中文的
    if(zkba>=0)
    {
     LIN1=1;     电机a的方向，这样是电机正转
     LIN2=0;
    }
    else
    {LIN1=0;LIN2=1;}

     if(zkbb>255)      这部分是电机b的，同上
     zkbb=255;
     if(zkbb<-255)
     zkbb=-255;
     zkb2=abs(zkbb);
     CCAP1H = zkb2;
     if(zkbb>=0)
      {RIN1=1;RIN2=0;}
      else
      {RIN1=0;RIN2=1;}
}

下面是16位的，只贴核心部分，都是些简单的代码。
uchar sum_get()
{
  char sensorData,i,sum;
   float bias=0;
   static unsigned char flagSensor[16] = {0};
   SWEN=0;      //读取低8位
   sensorData=P2;
   for(i=0; i<8; i++)
    {
        flagSensor = sensorData & 0x01;
        sensorData >>= 1;
    }
   SWEN=1;      //读取高8位
   sensorData=P2;
   for(i=8; i<16; i++)
    {
        flagSensor = sensorData & 0x01;
        sensorData >>= 1;
    }
    sum = 0;
    for(i=0; i<16; i++)
        if(flagSensor) sum ++;
        temp = 0;
    for(i=0; i<16; i++)
    {
        if(flagSensor)
            temp += (i+1);
    }
    return sum;
}

就写这么多，时间太长记不得了，语文差，写的有点乱！

+50 科创币

jrcsh 2012/03/12 鼓励新人

+10 科创币

云烟 2012/03/13 欢迎。现在我还停在用软件编.RCU的时代。虽然可以编代码。但是图形化用的更多。呵呵，高二

+10 科创币

爬行动物 2012/03/13

+50 科创币

kknd 2012/03/16 感谢开源

来自：仪器与装备 / 机械与工具

全部只看作者

~~空空如也

卡通童话008

13年6个月前 IP:未同步

380889

1楼

底盘哪里买的啊，求介绍··········

引用

加载评论中，请稍候...

200字以内，仅用于支线交流，主线讨论请采用回复功能。

折叠评论

旺旺

13年5个月前 IP:未同步

389554

2楼

电路图。。。。和图片。。。？？？？？[s:226]

引用

加载评论中，请稍候...

200字以内，仅用于支线交流，主线讨论请采用回复功能。

折叠评论

血狼

13年5个月前 IP:未同步

392404

3楼

楼主高手~~~有空教教我哈~

引用

加载评论中，请稍候...

200字以内，仅用于支线交流，主线讨论请采用回复功能。

折叠评论

想参与大家的讨论？现在就登录或者注册。

所属专业

机械与工具

所属分类

机器人

上级专业

仪器与装备

同级专业

仪器仪表拆机鉴赏

zuiyiyunyan

笔友

文章

学术分

2012/03/10注册，7年7个月前活动

暂无简介

主体类型：个人

所属领域：无

认证方式：邮箱

IP归属地：未同步

名片私信

作者最新文章

大二时做的小机器人，和大家分享下（有视频，高手勿喷）

机械与工具 zuiyiyunyan 13年6个月前

相似文章推荐

我也造了一台并联“机械臂”

机械与工具 10班陈大葱22号 14年1个月前

工业设计版软件介绍~

机械与工具燃气透平 12年9个月前

解析SLS 3DP成型现状

机械与工具魂溷 8年4个月前

新作完工！重型HID手提探照灯烈阳使者

机械与工具 power_rdx 15年2个月前

3Dprinter控制技术分析探讨

机械与工具魂溷 11年0个月前

中国（GB）钢铁牌号表示方法简介

机械与工具 LED 19年8个月前

【原创共享】自己DIY个铸铁数控雕铣机（图片多达上百张）

机械与工具浴血前锋 13年1个月前

金属空心锥形的一些研究与实验

机械与工具煎鸡蛋 1年4个月前

典型射频同轴连接器的界面尺寸测试

机械与工具虎哥 7年3个月前

解析粘土3D打印现状

机械与工具魂溷 9年5个月前

插入公式

温馨提示

1. 公式行内显示(inline)：请使用 $....$ 或 $....$ 包裹代码

2. 公式独占一行显示(display)：请使用 $$....$$ 或 \[....\] 包裹代码

3. 插入的公式在编辑时不会渲染，请检查无误后再插入。

公式输入

公式预览

\sum_{i = 0}^{N} \int_{a}^{b} g (t, i) d t

评论控制

加载中...

文号：{{pid}}

可查看、可评论

只可查看

不可查看、不可评论

投诉或举报

加载中...

请选择违规类型：

空空如也

提交成功！

笔记

{{fromNow(n.toc)}} {{n.status === noteStatus.disabled ? "已屏蔽" : ""}} {{n.status === noteStatus.unknown ? "正在审核" : ""}} {{n.status === noteStatus.deleted ? '已删除' : ''}}

编辑
删除
{{n.status === 'disabled' ? "解除屏蔽" : "屏蔽" }}

我也是有底线的