zhangyiss/gctl_toolkits
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

initial upload

Browse Source
This commit is contained in:
张壹
2024-09-10 20:25:18 +08:00
parent b8de03ee4f
commit f1cc876972
377 changed files with 2721267 additions and 34 deletions
Download Patch File Download Diff File Expand all files Collapse all files

82
gm3d/add_sphere_block.cpp Normal file
View File

@@ -0,0 +1,82 @@
#include "gm3d.h"
int GM3D::AddSphereBlock(modelist para_list){
double xc,yc,zc,rad_x,rad_y,rad_z;
double dist,rad_limit;
double rel_x,rel_y,rel_z,theta,phi;
bool model_added = false;
if (6 == sscanf(para_list.mod_para,"%lf/%lf/%lf/%lf/%lf/%lf",&xc,&yc,&zc,&rad_x,&rad_y,&rad_z)){
if (!strcmp(para_list.val_type,"replace")){
for (int i = 0; i < model_num_; i++){
rel_x = model_cube_[i].cen.x - xc;
rel_y = model_cube_[i].cen.y - yc;
rel_z = model_cube_[i].cen.z - zc;
dist = sqrt(rel_x*rel_x + rel_y*rel_y + rel_z*rel_z);
theta = acos(rel_z/dist);
phi = atan2(rel_y,rel_x);
rad_limit = rad_x*rad_y*rad_z/sqrt(pow(rad_y*rad_z*sin(theta)*cos(phi),2) + pow(rad_x*rad_z*sin(theta)*sin(phi),2) + pow(rad_x*rad_y*cos(theta),2));
if (dist <= rad_limit){
model_block_val_[i] = para_list.mod_value; //注意重复赋值的块体会覆盖
model_added = true;
}
}
}
else if (!strcmp(para_list.val_type,"add")){
for (int i = 0; i < model_num_; i++){
rel_x = model_cube_[i].cen.x - xc;
rel_y = model_cube_[i].cen.y - yc;
rel_z = model_cube_[i].cen.z - zc;
dist = sqrt(rel_x*rel_x + rel_y*rel_y + rel_z*rel_z);
theta = acos(rel_z/dist);
phi = atan2(rel_y,rel_x);
rad_limit = rad_x*rad_y*rad_z/sqrt(pow(rad_y*rad_z*sin(theta)*cos(phi),2) + pow(rad_x*rad_z*sin(theta)*sin(phi),2) + pow(rad_x*rad_y*cos(theta),2));
if (dist <= rad_limit){
if (model_block_val_[i] == BDL_MAX)
model_block_val_[i] = para_list.mod_value; //注意重复赋值的块体会覆盖
else
model_block_val_[i] += para_list.mod_value;
model_added = true;
}
}
}
else if (!strcmp(para_list.val_type,"erase")){
for (int i = 0; i < model_num_; i++){
rel_x = model_cube_[i].cen.x - xc;
rel_y = model_cube_[i].cen.y - yc;
rel_z = model_cube_[i].cen.z - zc;
dist = sqrt(rel_x*rel_x + rel_y*rel_y + rel_z*rel_z);
theta = acos(rel_z/dist);
phi = atan2(rel_y,rel_x);
rad_limit = rad_x*rad_y*rad_z/sqrt(pow(rad_y*rad_z*sin(theta)*cos(phi),2) + pow(rad_x*rad_z*sin(theta)*sin(phi),2) + pow(rad_x*rad_y*cos(theta),2));
if (dist <= rad_limit){
model_block_val_[i] = BDL_MAX; //注意重复赋值的块体会覆盖
model_added = true;
}
}
}
else{
cerr << BOLDRED << "error ==> " << RESET << "wrong value type: " << para_list.val_type << " of the model type: " << para_list.mod_type << endl;
return -1;
}
}
else{
cerr << BOLDRED << "error ==> " << RESET << "fail to add blocks with the parameter: " << para_list.mod_para << endl;
return -1;
}
if (!model_added){
cerr << BOLDYELLOW << "warning ==> " << RESET << "no block changed with the parameter: " << para_list.mod_para << endl;
return -1;
}
return 0;
}