一种求多边形的边上所有间隔一定距离的点坐标方法

2023-10-13 06:40

本文主要是介绍一种求多边形的边上所有间隔一定距离的点坐标方法,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

一种求多边形的边上所有间隔一定距离的点坐标方法

给一个任意多边形,得到每条边上间隔一定距离所有的点
环境:ros 、c++
效果图:
点间隔10cm

代码如下:
geometry_msgs::Polygon 为多边形类型。
std::vector<geometry_msgs::Point32> &为要求的点存放的地方的引用。
首先定义geometry_msgs::Polygon 和std::vector<geometry_msgs::Point32> &points
类型数据,如:
geometry_msgs::Polygon polygon ;
std::vector<geometry_msgs::Point32> &points;
然后调用:
getPointFromPolygon(polygon,points);
在points中就得到要求的所有的点。

bool getPointFromPolygon(geometry_msgs::Polygon polygon, std::vector<geometry_msgs::Point32> &points)
{size_t point_size = polygon.points.size();for(size_t i=0;i<point_size-1;i++){getPointFromLine(polygon.points[i],polygon.points[i+1],points);}getPointFromLine(polygon.points[point_size-1],polygon.points[0],points);return true;
}bool getPointFromLine(geometry_msgs::Point32 point0, geometry_msgs::Point32 point1, std::vector<geometry_msgs::Point32> &points)
{double dist = 0.1; //点间隔距离double theta  = 0,incr_x = 0,incr_y = 0;if(fabs(point1.x-point0.x) < 0.0000001){theta = M_PI_2;}else{theta = atan2(point1.y-point0.y,point1.x-point0.x);}incr_x = fabs(dist*cos(theta));incr_y = fabs(dist*sin(theta));geometry_msgs::Point32 tem_point;double diff_x = point1.x - point0.x;double diff_y = point1.y - point0.y;size_t point_size = (size_t)( sqrt(diff_x*diff_x+diff_y*diff_y)/dist+0.5 );if(point_size < 1){points.push_back(point0);points.push_back(point1);return true;}double x_vec[point_size+2]={0};double y_vec[point_size+2]={0};if(point0.x < point1.x){for(size_t i=0;i<point_size;i++){x_vec[i] = point0.x + i*incr_x;}}else{for(size_t i=0;i<point_size;i++){x_vec[i] = point0.x - i*incr_x;}}if(point0.y < point1.y){for(size_t i=0;i<point_size;i++){y_vec[i] = point0.y + i*incr_y;}}else{for(size_t i=0;i<point_size;i++){y_vec[i] = point0.y - i*incr_y;}}for(size_t i=0;i<point_size;i++){tem_point.x = x_vec[i];tem_point.y = y_vec[i];points.push_back(tem_point);}return true;
}

这篇关于一种求多边形的边上所有间隔一定距离的点坐标方法的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/201441

相关文章

Nginx安全防护的多种方法

《Nginx安全防护的多种方法》在生产环境中,需要隐藏Nginx的版本号,以避免泄漏Nginx的版本,使攻击者不能针对特定版本进行攻击,下面就来介绍一下Nginx安全防护的方法,感兴趣的可以了解一下... 目录核心安全配置1.编译安装 Nginx2.隐藏版本号3.限制危险请求方法4.请求限制(CC攻击防御)

python生成随机唯一id的几种实现方法

《python生成随机唯一id的几种实现方法》在Python中生成随机唯一ID有多种方法,根据不同的需求场景可以选择最适合的方案,文中通过示例代码介绍的非常详细,需要的朋友们下面随着小编来一起学习学习... 目录方法 1:使用 UUID 模块(推荐)方法 2:使用 Secrets 模块(安全敏感场景)方法

MyBatis-Plus通用中等、大量数据分批查询和处理方法

《MyBatis-Plus通用中等、大量数据分批查询和处理方法》文章介绍MyBatis-Plus分页查询处理,通过函数式接口与Lambda表达式实现通用逻辑,方法抽象但功能强大,建议扩展分批处理及流式... 目录函数式接口获取分页数据接口数据处理接口通用逻辑工具类使用方法简单查询自定义查询方法总结函数式接口

MySQL深分页进行性能优化的常见方法

《MySQL深分页进行性能优化的常见方法》在Web应用中,分页查询是数据库操作中的常见需求,然而,在面对大型数据集时,深分页(deeppagination)却成为了性能优化的一个挑战,在本文中,我们将... 目录引言:深分页,真的只是“翻页慢”那么简单吗?一、背景介绍二、深分页的性能问题三、业务场景分析四、

JAVA中安装多个JDK的方法

《JAVA中安装多个JDK的方法》文章介绍了在Windows系统上安装多个JDK版本的方法,包括下载、安装路径修改、环境变量配置(JAVA_HOME和Path),并说明如何通过调整JAVA_HOME在... 首先去oracle官网下载好两个版本不同的jdk(需要登录Oracle账号,没有可以免费注册)下载完

Java中读取YAML文件配置信息常见问题及解决方法

《Java中读取YAML文件配置信息常见问题及解决方法》:本文主要介绍Java中读取YAML文件配置信息常见问题及解决方法,本文给大家介绍的非常详细,对大家的学习或工作具有一定的参考借鉴价值,需要... 目录1 使用Spring Boot的@ConfigurationProperties2. 使用@Valu

Java 方法重载Overload常见误区及注意事项

《Java方法重载Overload常见误区及注意事项》Java方法重载允许同一类中同名方法通过参数类型、数量、顺序差异实现功能扩展,提升代码灵活性,核心条件为参数列表不同,不涉及返回类型、访问修饰符... 目录Java 方法重载(Overload)详解一、方法重载的核心条件二、构成方法重载的具体情况三、不构

SQL中如何添加数据(常见方法及示例)

《SQL中如何添加数据(常见方法及示例)》SQL全称为StructuredQueryLanguage,是一种用于管理关系数据库的标准编程语言,下面给大家介绍SQL中如何添加数据,感兴趣的朋友一起看看吧... 目录在mysql中,有多种方法可以添加数据。以下是一些常见的方法及其示例。1. 使用INSERT I

Python中反转字符串的常见方法小结

《Python中反转字符串的常见方法小结》在Python中,字符串对象没有内置的反转方法,然而,在实际开发中,我们经常会遇到需要反转字符串的场景,比如处理回文字符串、文本加密等,因此,掌握如何在Pyt... 目录python中反转字符串的方法技术背景实现步骤1. 使用切片2. 使用 reversed() 函

Python中将嵌套列表扁平化的多种实现方法

《Python中将嵌套列表扁平化的多种实现方法》在Python编程中,我们常常会遇到需要将嵌套列表(即列表中包含列表)转换为一个一维的扁平列表的需求,本文将给大家介绍了多种实现这一目标的方法,需要的朋... 目录python中将嵌套列表扁平化的方法技术背景实现步骤1. 使用嵌套列表推导式2. 使用itert