智能车制作

标题: 曲率算法 [打印本页]

作者: 么饿么么么 时间: 2016-6-4 18:54
标题: 曲率算法
曲率算法，怎莫整呢？？？？？求大神指教，最好有代码.

:):)
顺便送点福利

作者: 斯特凡 时间: 2016-6-4 18:54
#include<stdio.h>
int FinalLine=10,BasedLine=0;
int AvaliableLines,MiddleLine;
int SumX,SumY;
int Path[10];
int AverageX,AverageY,SumUp,SumDown,B,A;
void main()
{
int i;
for(i=0;i<10;i++)
scanf("%d",&Path[i]);
AvaliableLines=FinalLine-BasedLine; // FinalLine为终止行，
MiddleLine=(BasedLine+FinalLine)/2;
SumX=0;
SumY=0;
for(i=BasedLine;i<FinalLine;i++)
{
SumX+=i;
SumY+=Path[i];
}
AverageX=SumX/AvaliableLines;
AverageY=SumY/AvaliableLines;
SumUp=0;
SumDown=0;
for(i=BasedLine;i<FinalLine;i++)
{
SumUp+=(Path[i]-AverageY)*(i-AverageX);
SumDown+=(i-AverageX)*(i-AverageX);
}
if(SumDown==0) B=0;
else B=(int)(SumUp/SumDown);
A=(SumY-B*SumX)/AvaliableLines;
printf("%d %d",A,B);
}

作者: 光电小白 时间: 2016-6-4 20:00
同求？？？

作者: 黄河五路391號 时间: 2016-6-5 15:03
楼主的畸变校是怎么做的？

欢迎光临智能车制作 (http://dns.znczz.com/)