C语言实现三角定位(两点定位)

2024-04-15 17:04

本文主要是介绍C语言实现三角定位(两点定位),希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

原理与步骤详解

  1. 定义结构体与变量

    首先,定义了一个Point结构体来表示二维平面上的点,包含xy两个成员变量。在main函数中,我们定义了两个圆心c1c2,以及对应的半径r1r2,还有用于存储交点的p1p2

  2. 判断两圆关系

    在计算交点之前,我们需要先判断两个圆的位置关系。这可以通过比较两个圆心之间的距离d与两个圆的半径之和或差来实现。

    d = ( c 2. x − c 1. x ) 2 + ( c 2. y − c 1. y ) 2 d = \sqrt{(c2.x - c1.x)^2 + (c2.y - c1.y)^2} d=(c2.xc1.x)2+(c2.yc1.y)2

    如果d > r1 + r2,说明两个圆相离,没有交点。

    如果d < |r1 - r2|,说明一个圆在另一个圆的内部,也没有交点。

    如果以上两种情况都不满足,说明两个圆可能相交或相切,我们可以继续下一步的计算。

  3. 计算交点

    假设两个圆的方程分别为:

    ( x − c 1. x ) 2 + ( y − c 1. y ) 2 = r 1 2 (x - c1.x)^2 + (y - c1.y)^2 = r1^2 (xc1.x)2+(yc1.y)2=r12
    ( x − c 2. x ) 2 + ( y − c 2. y ) 2 = r 2 2 (x - c2.x)^2 + (y - c2.y)^2 = r2^2 (xc2.x)2+(yc2.y)2=r22

    将两个圆的方程相减,可以消去二次项,得到一个线性方程。这个线性方程表示两个圆的公共弦(如果相交的话)。

    通过代数变换,我们可以得到公共弦所在直线的斜率和截距,进而确定直线方程。然后,将这条直线方程与其中一个圆的方程联立,解出交点的坐标。

    但是,直接联立解方程比较复杂。代码中采用了一种更简洁的方法:利用几何关系求解。

    首先,通过圆心距d和半径r1r2,我们可以计算出一个中间变量a,它表示从圆心c1到交点所在直线的垂线段长度。

    a = r 1 2 − r 2 2 + d 2 2 d a = \frac{r1^2 - r2^2 + d^2}{2d} a=2dr12r22+d2

    然后,利用勾股定理计算出垂足到交点的距离h

    h = r 1 2 − a 2 h = \sqrt{r1^2 - a^2} h=r12a2

    接下来,我们需要确定交点的具体位置。这可以通过在直线(公共弦)上沿垂线的方向移动距离h来实现。为了得到这条直线的方向,我们可以利用两个圆心的连线与x轴的夹角来计算。最终,通过旋转和平移,我们可以得到两个交点的坐标。

  4. 输出结果

    最后,程序将计算得到的交点坐标打印出来。

代码如下:

#include <stdio.h>  
#include <math.h>  #define EPSILON 1e-6 // 用于浮点数比较的小量  typedef struct {  double x;  double y;  
} Point;  int intersectCircles(Point c1, double r1, Point c2, double r2, Point *p1, Point *p2) {  double dx = c2.x - c1.x;  double dy = c2.y - c1.y;  double d = sqrt(dx * dx + dy * dy); // 检查两圆是否相交  if (d > r1 + r2 || d < fabs(r1 - r2)) {  return 0; // 不相交或相离  } if (d == r1 + r2 || d == fabs(r1 - r2)) {  return 1; // 相切,交点为1个(理论上,这里不计算切点)  }  // 计算交点  double a = (r1 * r1 - r2 * r2 + d * d) / (2 * d);  double h = sqrt(r1 * r1 - a * a);  double x2 = c1.x + a * (c2.x - c1.x) / d;  double y2 = c1.y + a * (c2.y - c1.y) / d; double x3 = dy * h / d;  double y3 = -dx * h / d;  // 避免浮点误差导致的错误  if (fabs(dx) > fabs(dy)) {  p1->x = x2 + x3;  p1->y = y2 + y3;  p2->x  = x2 - x3;  p2->y = y2 - y3;  } else {  p1->x = x2 + y3;  p1->y = y2 + x3;  p2->x = x2 - y3;  p2->y = y2 - x3;  } 
return 2; // 相交,交点为2个  
}  int main() {  Point c1 = {0, 0};  double r1 = 5;  Point c2 = {7, 0};  double r2 = 3;  Point p1, p2;  int numPoints = intersectCircles(c1, r1, c2, r2, &p1, &p2);  if (numPoints == 2){  printf("Intersection points are: (%f, %f) and (%f, %f)\n", p1.x, p1.y, p2.x, p2.y);  } else if (numPoints == 1) {  printf("The circles are tangent.\n");  } else {  printf("The circles do not intersect.\n");  }  return 0;  
}

这篇关于C语言实现三角定位(两点定位)的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



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

相关文章

无人叉车3d激光slam多房间建图定位异常处理方案-墙体画线地图切分方案

墙体画线地图切分方案 针对问题:墙体两侧特征混淆误匹配,导致建图和定位偏差,表现为过门跳变、外月台走歪等 ·解决思路:预期的根治方案IGICP需要较长时间完成上线,先使用切分地图的工程化方案,即墙体两侧切分为不同地图,在某一侧只使用该侧地图进行定位 方案思路 切分原理:切分地图基于关键帧位置,而非点云。 理论基础:光照是直线的,一帧点云必定只能照射到墙的一侧,无法同时照到两侧实践考虑:关

hdu1043(八数码问题,广搜 + hash(实现状态压缩) )

利用康拓展开将一个排列映射成一个自然数,然后就变成了普通的广搜题。 #include<iostream>#include<algorithm>#include<string>#include<stack>#include<queue>#include<map>#include<stdio.h>#include<stdlib.h>#include<ctype.h>#inclu

【C++】_list常用方法解析及模拟实现

相信自己的力量,只要对自己始终保持信心,尽自己最大努力去完成任何事,就算事情最终结果是失败了,努力了也不留遗憾。💓💓💓 目录   ✨说在前面 🍋知识点一:什么是list? •🌰1.list的定义 •🌰2.list的基本特性 •🌰3.常用接口介绍 🍋知识点二:list常用接口 •🌰1.默认成员函数 🔥构造函数(⭐) 🔥析构函数 •🌰2.list对象

【Prometheus】PromQL向量匹配实现不同标签的向量数据进行运算

✨✨ 欢迎大家来到景天科技苑✨✨ 🎈🎈 养成好习惯,先赞后看哦~🎈🎈 🏆 作者简介:景天科技苑 🏆《头衔》:大厂架构师,华为云开发者社区专家博主,阿里云开发者社区专家博主,CSDN全栈领域优质创作者,掘金优秀博主,51CTO博客专家等。 🏆《博客》:Python全栈,前后端开发,小程序开发,人工智能,js逆向,App逆向,网络系统安全,数据分析,Django,fastapi

让树莓派智能语音助手实现定时提醒功能

最初的时候是想直接在rasa 的chatbot上实现,因为rasa本身是带有remindschedule模块的。不过经过一番折腾后,忽然发现,chatbot上实现的定时,语音助手不一定会有响应。因为,我目前语音助手的代码设置了长时间无应答会结束对话,这样一来,chatbot定时提醒的触发就不会被语音助手获悉。那怎么让语音助手也具有定时提醒功能呢? 我最后选择的方法是用threading.Time

Android实现任意版本设置默认的锁屏壁纸和桌面壁纸(两张壁纸可不一致)

客户有些需求需要设置默认壁纸和锁屏壁纸  在默认情况下 这两个壁纸是相同的  如果需要默认的锁屏壁纸和桌面壁纸不一样 需要额外修改 Android13实现 替换默认桌面壁纸: 将图片文件替换frameworks/base/core/res/res/drawable-nodpi/default_wallpaper.*  (注意不能是bmp格式) 替换默认锁屏壁纸: 将图片资源放入vendo

C#实战|大乐透选号器[6]:实现实时显示已选择的红蓝球数量

哈喽,你好啊,我是雷工。 关于大乐透选号器在前面已经记录了5篇笔记,这是第6篇; 接下来实现实时显示当前选中红球数量,蓝球数量; 以下为练习笔记。 01 效果演示 当选择和取消选择红球或蓝球时,在对应的位置显示实时已选择的红球、蓝球的数量; 02 标签名称 分别设置Label标签名称为:lblRedCount、lblBlueCount

科研绘图系列:R语言扩展物种堆积图(Extended Stacked Barplot)

介绍 R语言的扩展物种堆积图是一种数据可视化工具,它不仅展示了物种的堆积结果,还整合了不同样本分组之间的差异性分析结果。这种图形表示方法能够直观地比较不同物种在各个分组中的显著性差异,为研究者提供了一种有效的数据解读方式。 加载R包 knitr::opts_chunk$set(warning = F, message = F)library(tidyverse)library(phyl

透彻!驯服大型语言模型(LLMs)的五种方法,及具体方法选择思路

引言 随着时间的发展,大型语言模型不再停留在演示阶段而是逐步面向生产系统的应用,随着人们期望的不断增加,目标也发生了巨大的变化。在短短的几个月的时间里,人们对大模型的认识已经从对其zero-shot能力感到惊讶,转变为考虑改进模型质量、提高模型可用性。 「大语言模型(LLMs)其实就是利用高容量的模型架构(例如Transformer)对海量的、多种多样的数据分布进行建模得到,它包含了大量的先验

Kubernetes PodSecurityPolicy:PSP能实现的5种主要安全策略

Kubernetes PodSecurityPolicy:PSP能实现的5种主要安全策略 1. 特权模式限制2. 宿主机资源隔离3. 用户和组管理4. 权限提升控制5. SELinux配置 💖The Begin💖点点关注,收藏不迷路💖 Kubernetes的PodSecurityPolicy(PSP)是一个关键的安全特性,它在Pod创建之前实施安全策略,确保P