指向C中的直线特定距离

时间:2012-04-11 22:03:48

标签: c 2d euclidean-distance

如何在直线上找到距离给定点特定距离的点。我在C中编写这段代码,但我得不到正确的答案。难道你们有人指导我做错了什么。

我得到x1,y1,x2,y2值并且剩下的距离很好。使用这些我可以找到斜率m和y截距也很好。 现在,我需要在连接这两个点的直线上找到点,该点距点x1,y1 10个单位。我好像在这里出错了。这是我写的代码。

int x1 = node[n].currentCoordinates.xCoordinate;
int y1 = node[n].currentCoordinates.yCoordinate;
int x2 = node[n].destinationLocationCoordinates.xCoordinate;
int y2 = node[n].destinationLocationCoordinates.yCoordinate;

int distanceleft = (y2 - y1) * (y2 - y1) + (x2 - x1) * (x2 - x1);
distanceleft = sqrt(distanceleft);
printf("Distance left to cover is %d\n",distanceleft);
int m = (y2 - y1)/(x2 - x1); // slope.
int b = y1 - m * x1; //y-intercept


//find point on the line that is 10 units away from
//current coordinates on equation y = mx + b.
if(x2 > x1)
{
     printf("x2 is greater than x1\n");
     int tempx = 0;
     int tempy = 0;
     for(tempx = x1; tempx <= x2; tempx++)
     {
          tempy = y1 + (y2 - y1) * (tempx - x1)/(x2 - x1);
          printf("tempx = %d, tempy = %d\n",tempx,tempy);
          int distanceofthispoint = (tempy - y1) * (tempy - y1) + (tempx - x1) * (tempx - x1);
          distanceofthispoint = sqrt((int)distanceofthispoint);
          if(distanceofthispoint >= 10)
          {
               //found new points.
               node[n].currentCoordinates.xCoordinate = tempx;
               node[n].currentCoordinates.yCoordinate = tempy;
               node[n].TimeAtCurrentCoordinate = clock;
               printf("Found the point at the matching distance\n");
               break;
          }
     }
}
else
{
     printf("x2 is lesser than x1\n");
     int tempx = 0;
     int tempy = 0;
     for(tempx = x1; tempx >= x2; tempx--)
     {
          tempy = y1 + (y2 - y1) * (tempx - x1)/(x2 - x1);
          printf("tempx = %d, tempy = %d\n",tempx,tempy);
          int distanceofthispoint = (tempy - y1) * (tempy - y1) + (tempx - x1) * (tempx - x1);
          distanceofthispoint = sqrt((int)distanceofthispoint);
          if(distanceofthispoint >= 10)
          {
               //found new points.
               node[n].currentCoordinates.xCoordinate = tempx;
               node[n].currentCoordinates.yCoordinate = tempy;
               node[n].TimeAtCurrentCoordinate = clock;
               printf("Found the point at the matching distance\n");
               break;
          }
     }
}
printf("at time %f, (%d,%d) are the coordinates of node %d\n",clock,node[n].currentCoordinates.xCoordinate,node[n].currentCoordinates.yCoordinate,n);

2 个答案:

答案 0 :(得分:7)

以下是数学方面的内容,我没有时间用C语言写作。

您有一个点(x1,y1)和另一个点(x2,y2),在链接时会为您提供一个段。

因此,您有一个方向向量v=(xv, yv),其中xv=x2-x1yv=y2-y1

现在,您需要将此向量除以其范数,您将获得一个新向量: vector = v / sqrt(xv 2 + yv 2

现在,您只需要在原点上添加矢量乘以您想要点的距离:

位置=(x原点,y原点)+距离×矢量

我希望这有帮助!

答案 1 :(得分:0)

或者更简单,

从坡度中找出角度

θ = arctan(y2-y1/x2-x1)

您可能希望根据斜率的分子和分母修改θ的象限。然后你可以在距离(x1,y1)

的距离d处找到该线上的任何点
x_new = x1 + d×cos(θ)
y_new = y1 + d×sin(θ)

在这种情况下,你有d = 10