文号t79351
7633
5
收藏(4)
自制地图框架
qazwqsx2016/03/24软件综合 IP:美国 
#include "Map_all.h"
#include "MathMap.h"
#define PI 3.1415926525
#define FixConstant 1  //修正一米误差，左轮与右轮之比
#define Kp 1 //PID算法比例系数
#define Ki 1
#define Kd 1
   
bool TrunM;
extern bool FinishM; //in STM32Jack.c
double Fixvalue;
bool WaitM;
extern int MyA;
extern int MyX;
extern int MyY;
bool ImpactCM;
bool CrassM;
double ComModel_1[]={2,1.5,1,0.5,0,0.5,1,1.5};
double ComModel_2[]={1.5,2,1.5,1,0.5,0,0.5,1};
double ComModel_3[]={1,1.5,2,1.5,1,0.5,0,0.5};
double ComModel_4[]={0.5,1,1.5,2,1.5,1,0.5,0};
double ComModel_5[]={0,0.5,1,1.5,2,1.5,1,0.5};
double ComModel_6[]={0.5,0,0.5,1,1.5,2,1.5,1};
double ComModel_7[]={1,0.5,0,0.5,1,1.5,2,1.5};
double ComModel_8[]={1.5,1,0.5,0,0.5,1,1.5,2};
double Model[8][10];
//PID算法用
    double LE;
    double E;
    double IS;
    double RA;
    double Pv;
    double Cv;
//移动模式：
//  8  1  2
//  7     3
//  6  5  4
//  1为正北
//地图形式
//  (0,0)(0,1)(0,2)(0,3)……
//  (1,0)(1,1)(1,2)(1,2)……
//  (2,0)(2,1)(2,2)(2,3)……
//  ……
//标准直行函数
//输入参数：Number（前进格数）
//输出参数：无
void MoveTo(int Number){//no complete   need a stop mark 
  Moto_List New;
    New.DirectionLeft=1;
    New.DirectionRight=1;
    New.TimeLeft=(long)(1+Number)/(Wheellength*(0.9/32));
    New.TimeRight=(long)(1+Number)/(Wheellength*(0.9/32))+Fixvalue;
    MotoSetting(&New);
    while(FinishM!=true)
    FinishM=false;
}
//碰撞检测函数
//输入参数：无
//输出参数：无
void CheckImpact(void){
    int T_x;
    int T_y;
    if(FinishM==false){
        if(TrunM==false){
        if(MyA==1)
            {T_x=MyX-1;T_y=MyY;}
        else if(MyA==2)
            {T_x=MyX-1;T_y=MyY+1;}
        else if(MyA==3)
            {T_x=MyX;T_y=MyY+1;}
        else if(MyA==4)
            {T_x=MyX+1;T_y=MyY+1;}
        else if(MyA==5)
            {T_x=MyX+1;T_y=MyY;}
        else if(MyA==6)
            {T_x=MyX+1;T_y=MyY-1;}
        else if(MyA==7)
            {T_x=MyX;T_y=MyY-1;}
        else if(MyA==8)
            {T_x=MyX-1;T_y=MyY-1;}
        }
        if(CheckCrass(T_x,T_y)>2&&CrassM==false){
            TIM_Cmd(TIM2,DISABLE);//关闭步进用定时器
            CrassM=true;//写入交叉路口检测标志
            ImpactCom(T_x,T_y);//调用防碰撞通讯函数
            }
        else if(CheckCrass(T_x,T_y)>2&&CrassM==true){}
        else if(CheckCrass(T_x,T_y)<=2&&crassm==true){             crassm="false;//清除交叉路口检测标志"         } } 机器人路沿计算函数 输入参数：l左侧距，r右侧距 输出参数：左比总 double getecc(double l,double r){     return l (r+l); 路径校准函数 输入参数：无 输出参数：修正值 左轮 右轮 未完成 checkway(void){ return fix value  need each 1s used it          mya;     double r; l;     r="0;"     l="0;"     if(mya="=1){"         do{             l++;         }while(checkmap(7)="=true);"             r++;         }while(checkmap(3)="=true);"     }     else if(mya="=2){"         }while(checkmap(8)="=true);"         }while(checkmap(4)="=true);"         }while(checkmap(1)="=true);"         }while(checkmap(5)="=true);"         }while(checkmap(2)="=true);"         }while(checkmap(6)="=true);"            pv="getEcc(1,1);//其中1要改为左右超声测距值"     le="E;"     is="IS+E;"     e="(l/(l+r))-Pv;"     ra="E-LE;"   cv="E*Kp+RA*Kd+Ki*IS;" (cv*(l+r)); 标准转弯函数 输入参数：tangle（目标角度) 输出参数：无 void turnto(double tangle){     moto_list new;     if(tangle>0){
        New.DirectionLeft=1;
        New.DirectionRight=0;
    }
    else if(Tangle<0){         new.directionleft="0;"         new.directionright="1;"     }     new.timeleft="(long)(sqrt(Wheelbase)*PI*(Tangle/180))/(Wheellength*(0.9/32));"     new.timeright="(long)(sqrt(Wheelbase)*PI*(Tangle/180))/(Wheellength*(0.9/32));"     trunm="true;"     motosetting(&new);     while(finishm!="true);"     finishm="false;" } 前往点函数 输入参数：new 位置指针 输出参数：无 important void movecoo(loadinglist* new){     loadinglist diff;     recursion_cheak(new); int recursion_cheak(loadinglist*     creatmodel(1,new);     int i;     double s="2;" c="0;" crassn[2]="{0,0};"     while(1){      for(i="0;i<=7;i++){"          if(model[1]==S){
            C++;
            CrassN[C-1]=i;
         }
     }
     if(C<=0){          if(c="=1){"              if(checkmap(i)="=true)break;" } else if(new->X==MyX||New->Y==MyY||(New->X==MyX&&New->Y==MyY)){
                    
             }
             else{
                 Recursion_Cheak(New);
             }
                
         }
     }
     else{
         S-=0.5;
     }
    }
    return i;
}
//充电校准函数
//输入参数：无
//输出参数：无
void ChargeMove(void){
       
}
   
void CreatModel(int N,LoadingList* New){
    int j;
    if(New->MapX==MapNumber(1)&&New->MapY ==MapNumber(2)){
        if(New->X>MyX){
            if(New->Y>MyY){
            for(j=0;j<=7;j++){             model[j][n]="ComModel_4[j];"             }             if(new->Y==MyY){
            for(j=0;j<=7;j++){             model[j][n]="ComModel_3[j];  "             }             if(new->Y<myy){             for(j="0;j<=7;j++){"             model[j][n]="ComModel_2[j];  "             }         }         if(new->X==MyX){
            if(New->Y>MyY){
            for(j=0;j<=7;j++){             model[j][n]="ComModel_5[j];  "             }             if(new->Y<myy){             for(j="0;j<=7;j++){"             model[j][n]="ComModel_1[j];  "             }         }         if(new->X<myx){             if(new->Y>MyY){
            for(j=0;j<=7;j++){             model[j][n]="ComModel_6[j];  "             }             if(new->Y==MyY){
            for(j=0;j<=7;j++){             model[j][n]="ComModel_7[j];  "             }             if(new->Y<myy){             for(j="0;j<=7;j++){"             model[j][n]="ComModel_8[j];  "             }         }     }     else{         if(new->MapX>MapNumber(1)){
            if(New->MapY>MapNumber(2)){
            for(j=0;j<=7;j++){             model[j][n]="ComModel_4[j];  "             }             if(new->MapY==MapNumber(2)){
            for(j=0;j<=7;j++){             model[j][n]="ComModel_3[j];  "             }             if(new->MapY<mapnumber(2)){             for(j="0;j<=7;j++){"             model[j][n]="ComModel_2[j];  "             }         }         if(new->MapX==MapNumber(1)){
            if(New->MapY>MapNumber(2)){
            for(j=0;j<=7;j++){             model[j][n]="ComModel_5[j];  "             }             if(new->MapY<mapnumber(2)){             for(j="0;j<=7;j++){"             model[j][n]="ComModel_1[j];  "             }         }         if(new->MapX<mapnumber(1)){             if(new->MapY>MapNumber(2)){
            for(j=0;j<=7;j++){             model[j][n]="ComModel_6[j];  "             }             if(new->MapY==MapNumber(2)){
            for(j=0;j<=7;j++){             model[j][n]="ComModel_7[j];  "             }             if(new->MapY<mapnumber(2)){             for(j="0;j<=7;j++){"             model[j][n]="ComModel_8[j];  "             }         }     } }< i></mapnumber(2)){></=7;j++){></=7;j++){></mapnumber(1)){></mapnumber(2)){></=7;j++){></mapnumber(2)){></=7;j++){></=7;j++){></myy){></=7;j++){></=7;j++){></myx){></myy){></=7;j++){></myy){></=7;j++){></=7;j++){></=0){></0){></=2&&crassm==true){>
#include "Map_all.h"
#include "MathMap.h"
struct LiLa{
    double LA;
    double LI;
};
struct Black{
    struct LiLa My;
    int MoveType[8];
};
struct Coo{
    int X;
    int Y;
};
struct Black MAP[300][300];//X,Y
int List[300];
struct Coo MapNumber;
int MyX;
int MyY;
int MyA;
bool StopM;
int l;
//移动模式：
//  8  1  2
//  7     3
//  6  5  4
//  1为正北
//地图移动模式
//    1
//  4   2
//    3
//地图形式
//  (0,0)(0,1)(0,2)(0,3)……
//  (1,0)(1,1)(1,2)(1,2)……
//  (2,0)(2,1)(2,2)(2,3)……
//  ……
   
//地图加载函数
//输入参数：T移动模式
//输出参数：无
void loadmap(int T){// 1:up,,2:down,3:left,;4;right,0:beginmap                no complete
long i;
long j;
    switch(T){
        case 1:{
        LoadingList New;
        MapReport PMap;
        MapNumber.X=MapNumber.X;
        MapNumber.Y=MapNumber.Y-1;
        New.MapX=MapNumber.X;
        New.MapY=MapNumber.Y;
        for(i=0;i<=300;i++){             for(j="0;j<=300;j++){"             new.x="i;"             new.y="j;"             pmap="SDGetMap(&New);"             map[j].My.LA=PMap.La;
            MAP[j].My.LI=PMap.Li;
            for(l=0;l<=8;l++){                 map[j].MoveType[l]=PMap.MoveT[l];
                }
            }
        }
            break;
        }
        case 2:{
        LoadingList New;
        MapReport PMap;
        MapNumber.X=MapNumber.X+1;
        MapNumber.Y=MapNumber.Y;
        New.MapX=MapNumber.X;
        New.MapY=MapNumber.Y;
        for(i=0;i<=300;i++){             for(j="0;j<=300;j++){"             new.x="i;"             new.y="j;"             pmap="SDGetMap(&New);"             map[j].My.LA=PMap.La;
            MAP[j].My.LI=PMap.Li;
            for(l=0;l<=8;l++){                 map[j].MoveType[l]=PMap.MoveT[l];
                }
            }
        }
            break;
        }
        case 3:{
        LoadingList New;
        MapReport PMap;
        MapNumber.X=MapNumber.X;
        MapNumber.Y=MapNumber.Y+1;
        New.MapX=MapNumber.X;
        New.MapY=MapNumber.Y;
        for(i=0;i<=300;i++){             for(j="0;j<=300;j++){"             new.x="i;"             new.y="j;"             pmap="SDGetMap(&New);"             map[j].My.LA=PMap.La;
            MAP[j].My.LI=PMap.Li;
            for(l=0;l<=8;l++){                 map[j].MoveType[l]=PMap.MoveT[l];
                }
            }
        }
            break;
        }
        case 4:{
        LoadingList New;
        MapReport PMap;
        MapNumber.X=MapNumber.X-1;
        MapNumber.Y=MapNumber.Y;
        New.MapX=MapNumber.X;
        New.MapY=MapNumber.Y;
        for(i=0;i<=300;i++){             for(j="0;j<=300;j++){"             new.x="i;"             new.y="j;"             pmap="SDGetMap(&New);"             map[j].My.LA=PMap.La;
            MAP[j].My.LI=PMap.Li;
            for(l=0;l<=8;l++){                 map[j].MoveType[l]=PMap.MoveT[l];
                }
            }
        }
            break;
        }
        case 0:{
        LoadingList New;
        MapReport PMap;
        MyX=0;
        MyY=0;
        MapNumber.X=0;
        MapNumber.Y=0;
        New.MapX=MapNumber.X;
        New.MapY=MapNumber.Y;
        for(i=0;i<=300;i++){             for(j="0;j<=300;j++){"             new.x="i;"             new.y="j;"             pmap="SDGetMap(&New);"             map[j].My.LA=PMap.La;
            MAP[j].My.LI=PMap.Li;
            for(l=0;l<=8;l++){                 map[j].MoveType[l]=PMap.MoveT[l];
                }
            }
        }
            break;
        }
    }
}
//主移动函数函数
//输入参数：T移动模式，1：预定路线，2：随机路线，3：控制室控制
//输出参数：无
void MainMove(int T){
    loadmap(0);
    l=0;//error
    while(T==1){
     int i;
        if(List[l]==List[l-1]){
            while(List[l]==List[l+i]){i++;}
                MoveTo(i);
                //brack while
                l=l+i-1;
                if(StopM==true){break;}
        }
        else{
            TurnTo(45*(List[l]-List[l-1]));
            MoveTo(1);
            if(StopM==true){break;}
        }
        if(l<=300){             break;         }         else{             l++;     }     while(t="=2){"         int r; lastr;         do{         r="radom(9,1,2);//black" ad io         }while(checkmap(r)="=true);  "         if(r="=LastR){"                 moveto(1);             turnto(45*(r-lastr));             moveto(1);             if(stopm="=true){break;}"         lastr="R;"      *     command from computer     *     if(stopm="=true){break;}"                   } 地图检测函数 输入参数：type移动模式 输出参数：bool true表示可行 bool checkmap(int type){ error         if(map[myx][myy].movetype[type]="=1){"             return true; false; 检测交叉路口函数 输入参数：x,y坐标 输出参数：通道数 int checkcrass(int x,int y){     int i; out="0;"             for(i="0;I<=8;I++){"                 if(map[x][y].movetype==true){
                    Out++;
                    }
                }
            return Out;
}
void MapChan(int X,int Y){
    MapNumber.X=MapNumber.X+X;
    MapNumber.Y=MapNumber.X+Y;
}
int MapNumberC(int C){
    if(C==1){
        return MapNumber.X;
    }
    else if(C==2){
        return MapNumber.Y;
    }
}</=300){></=8;l++){></=300;i++){></=8;l++){></=300;i++){></=8;l++){></=300;i++){></=8;l++){></=300;i++){></=8;l++){></=300;i++){>





[修改于 8年10个月前 - 2016/03/26 00:32:59]

来自：计算机科学 / 软件综合
5
全部 只看作者
已屏蔽 原因：{{ notice.reason }}已屏蔽
屏蔽解除屏蔽编辑详情
{{notice.noticeContent}}
~~空空如也
novakon
8年10个月前 IP:广东
813570
1楼
这是让机器人跟线走地图的程序，也包含负责处理各种辅助传感器输入的代码。
提几个问题。
1. （从公布的文件来看）对变量和过程的注释太少，脱离具体硬件，几乎无法理解。
2. 没有介绍几种关键数据结构。
3. 过于冗长，重复黏贴部分过多，阅读困难，应考虑重构。
4. （别在意哈）所用英文单词拼写错误较多。

楼主如果能够从架构上来介绍一下这个程序，帖子会更有价值一些。
引用
评论
加载评论中，请稍候...
200字以内，仅用于支线交流，主线讨论请采用回复功能。
折叠评论
csaaa
8年10个月前 IP:浙江
813592
2楼
楼主加油，等你的测试版。
引用
评论
加载评论中，请稍候...
200字以内，仅用于支线交流，主线讨论请采用回复功能。
折叠评论
qazwqsx作者
8年10个月前 IP:美国
813725
3楼
终于可以用高级编辑了，但是感觉还是比较难用
引用
评论
加载评论中，请稍候...
200字以内，仅用于支线交流，主线讨论请采用回复功能。
折叠评论
phpskycn
8年10个月前 IP:浙江
813726
4楼
引用 qazwqsx:
终于可以用高级编辑了，但是感觉还是比较难用
唔，LZ修改过之后帖子清晰了很多
引用
评论
加载评论中，请稍候...
200字以内，仅用于支线交流，主线讨论请采用回复功能。
折叠评论

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

所属专业
软件综合
上级专业
计算机科学
同级专业
计算机电子学
qazwqsx
进士 机友 笔友
文章
30
回复
36
学术分
0
2013/10/20注册，3年6个月前活动
暂无简介
主体类型：个人
所属领域：无
认证方式：手机号
IP归属地：未同步
名片私信
作者最新文章
串口缓存函数
软件综合qazwqsx 8年10个月前
高速质数表
软件综合qazwqsx 8年10个月前
自制地图框架
软件综合qazwqsx 8年10个月前
在论坛里的高级功能基本上都用不了
社区公务qazwqsx 8年10个月前
（基于内置地图的移动程序）STM32系统
软件综合qazwqsx 8年11个月前
求大神吐槽，自写地图模块
软件综合qazwqsx 8年11个月前
关于C二维结构体数组赋值与调用的问题
软件综合qazwqsx 9年0个月前
串口调试软件v2.0 beta（原创）
电子技术qazwqsx 9年2个月前
单片机上位机控制程序（原创）
电子技术qazwqsx 9年2个月前
单片机上位机控制程序
软件综合qazwqsx 9年2个月前
相似文章推荐
一个小程序：MousTired，计算你的鼠标走了多远
软件综合fw。 16年1个月前
控制网络流量规则变化并输出波形——NetWaveOutput
软件综合ldc 16年2个月前
【当下的未来】漫谈GPT4潜在的生产力与教育价值
软件综合汉斯喵喵 10个月9天前
【教程】10分钟学会用MFC写算法
软件综合acmilan 9年10个月前
计算机仿真电路原理简介 - 入门！
软件综合金坷居士 8年6个月前
【楼下更新】简单省事的3D图形演示程序
软件综合novakon 12年8个月前
大爱的CUDA：图像亮度直方图统计
软件综合小俊 15年7个月前
SVPWM的通俗讲解~
软件综合yanli12321 10年9个月前
解剖一个U盘病毒~
软件综合ldc 16年1个月前
Visual C++中的工作线程分离
软件综合acmilan 9年8个月前
插入公式
评论控制
加载中...
文号：{{pid}}
投诉或举报
加载中...
{{tip}}
请选择违规类型：
{{reason.type}}

空空如也

提交成功！
加载中...
详情
详情
推送到专栏从专栏移除
设为匿名取消匿名
查看作者
回复
只看作者
加入收藏取消收藏
收藏
取消收藏
折叠回复
置顶取消置顶
评学术分
鼓励
设为精选取消精选
管理提醒
编辑
通过审核
评论控制
退修或删除
历史版本
违规记录
投诉或举报
加入黑名单移除黑名单
查看IP
{{format('YYYY/MM/DD HH:mm:ss', toc)}}