码迷,mamicode.com
首页 > 其他好文 > 详细

根据道路主线画边界线

时间:2015-04-08 18:00:28      阅读:153      评论:0      收藏:0      [点我收藏+]

标签:

        /// <summary>
        /// 通过中心线关键点获取左右辅助线关键点
        /// </summary>
        /// <param name="centerPoints">中心线关键点</param>
        /// <param name="leftWidth">道路左距离</param>
        /// <param name="rightWidth">道路右距离</param>
        /// <returns>左右辅助线的点集合</returns>
        private Tuple<Point[], Point[]> GetAuxiliaryLinePointsByCenterLinePoints(Collection<Point> centerPoints, double leftWidth, double rightWidth)
        {
            int pointCount = centerPoints.Count;
            Point[] leftPoints = new Point[pointCount],
                rightPoints = new Point[pointCount];

            for (int i = 1; i < pointCount; i++)
            {
                if (centerPoints[i].X.Equals(centerPoints[i - 1].X))
                {
                    if (centerPoints[i].Y > centerPoints[i - 1].Y)
                    {
                        leftPoints[i - 1] = new Point(centerPoints[i - 1].X - leftWidth, centerPoints[i - 1].Y);
                        leftPoints[i] = new Point(centerPoints[i].X - leftWidth, centerPoints[i].Y);
                        rightPoints[i - 1] = new Point(centerPoints[i - 1].X + rightWidth, centerPoints[i - 1].Y);
                        rightPoints[i] = new Point(centerPoints[i].X + rightWidth, centerPoints[i].Y);
                    }
                    else
                    {
                        leftPoints[i - 1] = new Point(centerPoints[i - 1].X + leftWidth, centerPoints[i - 1].Y);
                        leftPoints[i] = new Point(centerPoints[i].X + leftWidth, centerPoints[i].Y);
                        rightPoints[i - 1] = new Point(centerPoints[i - 1].X - rightWidth, centerPoints[i - 1].Y);
                        rightPoints[i] = new Point(centerPoints[i].X - rightWidth, centerPoints[i].Y);
                    }

                }
                else
                {
                    Point[] pointsleft1 =
                                GetPointsOfDistanceToPointOnTheLine(new Point[] { centerPoints[i - 1], centerPoints[i] },
                                    leftWidth, true);
                    Point[] pointsleft2 =
                       GetPointsOfDistanceToPointOnTheLine(new Point[] { centerPoints[i - 1], centerPoints[i] },
                           leftWidth, false);
                    Point[] pointsRight1 =
                        GetPointsOfDistanceToPointOnTheLine(new Point[] { centerPoints[i - 1], centerPoints[i] },
                            rightWidth, true);
                    Point[] pointsRight2 =
                      GetPointsOfDistanceToPointOnTheLine(new Point[] { centerPoints[i - 1], centerPoints[i] },
                          rightWidth, false);
                    if (centerPoints[i].Y > centerPoints[i - 1].Y)
                    {
                        leftPoints[i - 1] = pointsleft1[0];
                        leftPoints[i] = pointsleft2[0];
                        rightPoints[i - 1] = pointsRight1[1];
                        rightPoints[i] = pointsRight2[1];
                    }
                    else
                    {
                        leftPoints[i - 1] = pointsleft1[1];
                        leftPoints[i] = pointsleft2[1];
                        rightPoints[i - 1] = pointsRight1[0];
                        rightPoints[i] = pointsRight2[0];
                    }
                }
                if (i != 1)
                {
                    Point tempLeftPoint, tempRightPoint;
                    tempLeftPoint = leftPoints[i - 1];
                    tempRightPoint = rightPoints[i - 1];

                    Point[] leftOutsideRoadPoints = new Point[4];
                    leftOutsideRoadPoints[0] = leftPoints[i - 2];
                    leftOutsideRoadPoints[1] = leftPoints[i - 1];
                    leftOutsideRoadPoints[2] = tempLeftPoint;
                    leftOutsideRoadPoints[3] = leftPoints[i];
                    Point leftIntersectiony = GetIntersectionyOfTwoLines(leftOutsideRoadPoints);
                    leftPoints[i - 1] = leftIntersectiony;

                    Point[] rightOutsideRoadPoints = new Point[4];
                    rightOutsideRoadPoints[0] = rightPoints[i - 2];
                    rightOutsideRoadPoints[1] = rightPoints[i - 1];
                    rightOutsideRoadPoints[2] = tempRightPoint;
                    rightOutsideRoadPoints[3] = rightPoints[i];
                    Point rightIntersectiony = GetIntersectionyOfTwoLines(rightOutsideRoadPoints);
                    rightPoints[i - 1] = rightIntersectiony;
                }
            }
            return new Tuple<Point[], Point[]>(leftPoints, rightPoints);
        }

        /// <summary>
        /// 求到直线固定点、固定距离的点坐标
        /// </summary>
        /// <param name="linePoint">确定一条直线的两个点</param>
        /// <param name="distance">到直线的距离</param>
        /// <param name="relativeFristPoint">所求点是对应直线两点的哪一个:true-对应linePoint[0]点;false-对应linePoint[1]点</param>
        /// <returns>到直线上特定点固定距离的两个点数组</returns>
        private Point[] GetPointsOfDistanceToPointOnTheLine(Point[] linePoint, double distance, bool relativeFristPoint = true)
        {
            Point[] points = new Point[2];

            Point relativePoint = relativeFristPoint ? linePoint[0] : linePoint[1];

            if (linePoint.Length != 2)
                throw new AggregateException("参数个数不正确");

            if (linePoint[0].Equals(linePoint[1]) && Math.Abs(distance) < 0.1)
                throw new ArgumentException("参数不正确");

            if (linePoint[0].X.Equals(linePoint[1].X))   //垂直直线
            {
                points[0] = new Point(relativePoint.X - distance, relativePoint.Y);
                points[1] = new Point(relativePoint.X + distance, relativePoint.Y);
            }
            else if (linePoint[0].Y.Equals(linePoint[1].Y))   //水平直线
            {
                points[0] = new Point(relativePoint.X, relativePoint.Y + distance);
                points[1] = new Point(relativePoint.X, relativePoint.Y - distance);
            }
            else
            {
                double differenceY = linePoint[1].Y - linePoint[0].Y;
                double differenceX = linePoint[1].X - linePoint[0].X;

                double centerValue = Math.Sqrt(Math.Pow(distance, 2) - (1 + Math.Pow(differenceY / differenceX, 2)));

                double getX1 = relativePoint.X + centerValue;
                double getY1 = differenceX * (relativePoint.X - getX1) / differenceY + relativePoint.Y;
                points[1] = new Point(getX1, getY1);


                double getX2 = relativePoint.X - centerValue;
                double getY2 = differenceX * (relativePoint.X - getX2) / differenceY + relativePoint.Y;
                points[0] = new Point(getX2, getY2);
            }

            return points;
        }

        /// <summary>
        /// 求两条线的交点
        /// </summary>
        /// <param name="point">前两个点与后两个点分别确定两条直线</param>
        /// <returns>两直线焦点</returns>
        private Point GetIntersectionyOfTwoLines(Point[] point)
        {
            Point intersectiony = new Point();

            if (point.Length != 4)
                throw new AggregateException("参数个数不正确");

            if (point[0].Equals(point[1]) && point[2].Equals(point[4]))
                throw new ArgumentException("参数相同");

            bool line1IsVertical, line2IsVertical;
            line1IsVertical = point[1].X.Equals(point[0].X);
            line2IsVertical = point[3].X.Equals(point[2].X);

            if (line1IsVertical || line2IsVertical)  //两条直线存在垂直的情况
            {
                if (line1IsVertical && line2IsVertical)
                {
                    throw new ArgumentException("两直线平行,无交点");
                }
                else
                {
                    if (line1IsVertical)
                    {
                        intersectiony.X = point[0].X;

                        double differenceX = point[3].X - point[2].X;
                        double differenceY = point[3].Y - point[2].Y;

                        intersectiony.Y = differenceY * (intersectiony.X - point[2].X) / differenceX + point[2].Y;
                    }
                    else
                    {
                        intersectiony.X = point[2].X;

                        double differenceX = point[1].X - point[0].X;
                        double differenceY = point[1].Y - point[0].Y;

                        intersectiony.Y = differenceY * (intersectiony.X - point[0].X) / differenceX + point[0].Y;
                    }
                }
            }
            else
            {
                double differenceX1 = point[1].X - point[0].X;
                double differenceX2 = point[3].X - point[2].X;
                double differenceY1 = point[1].Y - point[0].Y;
                double differenceY2 = point[3].Y - point[2].Y;

                if ((differenceY1 * differenceX2).Equals(differenceY2 * differenceX1))
                {
                    throw new ArgumentException("两直线平行,无交点");
                }
                else
                {
                    intersectiony.X = (point[0].Y - point[2].Y + differenceY2 * point[2].X / differenceX2 - differenceY1 * point[0].X / differenceX1) /
                                      (differenceY2 / differenceX2 - differenceY1 / differenceX1);
                    intersectiony.Y = differenceY1 * (intersectiony.X - point[0].X) / differenceX1 + point[0].Y;
                }
            }


            return intersectiony;
        }

 

根据道路主线画边界线

标签:

原文地址:http://www.cnblogs.com/moisten/p/4403062.html

(0)
(0)
   
举报
评论 一句话评论(0
登录后才能评论!
© 2014 mamicode.com 版权所有  联系我们:gaon5@hotmail.com
迷上了代码!