我有一堆具有阈值的数学操作,但无论我改变什么,if语句总是返回true。没有编译错误,无法使调试器工作。这是一个函数,X Y和Z数组都是正确的(我打印它们以便先检查),数学对于刀片距离检查至少是正确的,但总是返回true。我通过matlab运行了相同的代码(显然是重写的),并且根据我的数据返回true或false,所以很明显,这与我写这个错误的方式有关。还有什么方法可以缩小这个范围吗?
bool Device::_SafeD(char _Type, float _Data[20][3]) {
bool S;
double x[20], y[20], z[20];
for (int i=0; i<20; i++) {
x[i] = _Data[i][0];
y[i] = _Data[i][1];
z[i] = _Data[i][2];
}
// Check angles for needle
if (_Type == 'n') {
for (int i=0; i<20; i++) {
float dot, moda, modb, c, angle;
dot = ((x[i]*x[i+1]) + (y[i]*y[i+1]) + (z[i]*z[i+1]));
moda = sqrt(pow(x[i],2)+pow(y[i],2)+pow(z[i],2));
modb = sqrt(pow(x[i+1],2)+(y[i+1],2)+(z[i+1],2));
c = dot/(moda*modb);
angle = acos(c);
if (angle > 45){
S = 0;
} else {
S = 1;
}
}
}
// Check distance for blade
if (_Type == 'b'){
for (int i=0; i<19; i++) {
float distance = (x[i+1]-x[i]) + (y[i+1]-y[i]) + (z[i+1]-z[i]);
cout << "distance " << distance << endl;
if (distance > 5.0) {
S = 0;
} else {
S = 1;
}
}
}
if (S == 0) {
return 0;
}
if(S == 1) {
return 1;
}
}
干杯
答案 0 :(得分:0)
最可能的错误是您将angle
与度数角度进行比较,而acos
的返回值为弧度。
if (angle > 45){
在比较45之前将角度转换为度数,你应该没问题。
if (radians_to_degrees(angle) > 45){
其中
double radians_to_degrees(double in)
{
return (in*180/M_PI);
}
另一种选择是以弧度计算45度的等效值,并将其与angle
进行比较。
double const radian_45 = M_PI*45.0/180;
并使用
if (angle > radian_45){
@Bob __:
在评论中清楚地阐明了另一个错误OP使用两个循环来检查角度和距离,在这些循环中,标记(
S
)设置为0
或1
,但它已完成数组中的每个索引都被覆盖了。整个函数的返回值(在提供的代码中)仅取决于数组中的最后两个元素。