Skip to content

优化代码结构 #1

New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

Sign up for GitHub

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Open
wants to merge 2 commits into
base: master
Choose a base branch
from
Open

优化代码结构 #1

Changes from all commits
Commits
Show all changes
2 commits
Select commit Hold shift + click to select a range
1b3ef59
修改部分main结构
346970897 Apr 1, 2024
3d93407
merge代码
346970897 Apr 1, 2024
File filter

Filter by extension

Filter by extension
Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
297 changes: 71 additions & 226 deletions main.cpp
View file
Open in desktop
Original file line number Diff line number Diff line change
@@ -1,249 +1,101 @@
#include <stdio.h>
#include <stdlib.h>
#include <cstdio>
#include <cstdlib>
#include <iostream>
#include <cmath>
#include <string>
#include <stack>
#include <typeinfo>
#include <fstream>
#include <sstream>
#include <vector>
#include <limits>
// #include <json/json.h>
#include <regex>

// #include <E:/Project_C/json_lib/json/include/nlohmann/json.hpp>

typedef struct DataPoint
{
struct DataPoint {
int posi_ID_x = 0;
int posi_ID_y = 0;
double mean_x = 0.0;
double mean_y = 0.0;
double weight_x = 0.0;
double weight_y = 0.0;
} DataPoint;



std::vector<DataPoint> dataPoints;

int charToInt(char c)
{
return c - '0';
}

double charToDouble(char c)
{
return static_cast<double>(c - '0');
}

double stringToDouble(const std::string &str)
{
return std::stod(str);
}
};

double distance(double x1, double y1, double x2, double y2) {
return sqrt(pow(x1 - x2, 2) + pow(y1 - y2, 2));}
return sqrt(pow(x1 - x2, 2) + pow(y1 - y2, 2));
}

std::vector<DataPoint> surround_by(double x, double y, DataPoint this_point, const std::vector<DataPoint>& dataPoints)
{
std::vector<DataPoint> surround_by(double x, double y, DataPoint this_point, const std::vector<DataPoint> &dataPoints) {
std::vector<DataPoint> four_point;
int vector_x = -1, vector_y = -1;
if (x - this_point.mean_x > 0){vector_x = 1;}
if (y - this_point.mean_y > 0){vector_y = 1;}
for (const auto& gridPoint : dataPoints)
{
if (gridPoint.posi_ID_x == this_point.posi_ID_x && gridPoint.posi_ID_y == this_point.posi_ID_y)
{
if (x - this_point.mean_x > 0) { vector_x = 1; }
if (y - this_point.mean_y > 0) { vector_y = 1; }
for (const auto &gridPoint: dataPoints) {
if (gridPoint.posi_ID_x == this_point.posi_ID_x && gridPoint.posi_ID_y == this_point.posi_ID_y) {
four_point.push_back(gridPoint);
}
if (gridPoint.posi_ID_x == (this_point.posi_ID_x + vector_x) && gridPoint.posi_ID_y == this_point.posi_ID_y)
{
if (gridPoint.posi_ID_x == (this_point.posi_ID_x + vector_x) && gridPoint.posi_ID_y == this_point.posi_ID_y) {
four_point.push_back(gridPoint);
}
if (gridPoint.posi_ID_x == (this_point.posi_ID_x) && gridPoint.posi_ID_y == (this_point.posi_ID_y + vector_y))
{
if (gridPoint.posi_ID_x == (this_point.posi_ID_x) && gridPoint.posi_ID_y == (this_point.posi_ID_y + vector_y)) {
four_point.push_back(gridPoint);
}
if (gridPoint.posi_ID_x == (this_point.posi_ID_x + vector_x) && gridPoint.posi_ID_y == (this_point.posi_ID_y + vector_y))
{
if (gridPoint.posi_ID_x == (this_point.posi_ID_x + vector_x) &&
gridPoint.posi_ID_y == (this_point.posi_ID_y + vector_y)) {
four_point.push_back(gridPoint);
}

}
if (four_point.max_size() == 4) // TODO 这里要加入边界可能选点出错的情况处理
return four_point;
return four_point;
else printf("Matching error");

}

int read_table()
{
std::ifstream file("interp_table.txt"); // 检查文件是否成功打开
if (!file.is_open())
{
std::cerr << "Error: Unable to open file!" << std::endl;
}

extern std::vector<DataPoint> dataPoints;
std::vector<DataPoint> readDataPoints(const std::string& filename) {
std::vector<DataPoint> dataPoints;
std::ifstream file(filename);
std::string line;

while (std::getline(file, line))
{
bool flag_single_read = false;
bool is_neg = false;
std::string temp_num;
DataPoint dp;
int cont = 0; // 用于计数
for (size_t i = 0; i < line.length(); i++)
{
if (line[i] == ':')
{
cont++;
flag_single_read = true;
continue;
}
if (cont == 1 && flag_single_read == true)
{
dp.posi_ID_x = charToInt(line[i]);
flag_single_read = false;
}
if (cont == 2 && flag_single_read == true)
{
dp.posi_ID_y = charToInt(line[i]);
flag_single_read = false;
}

if (cont == 3 && flag_single_read == true)
{
if (line[i] == '-')
{
is_neg = true;
continue;
}
if (line[i] >= '0' && line[i] <= '9')
{
for (size_t j = 0; j < 10; j++)
{ if (line[i+j] >= '0' && line[i+j] <= '9'|| line[i+j] =='.')
{temp_num += line[i + j];}
else break;
}
flag_single_read = false;
if (is_neg == true)
{
dp.mean_x = (-1) * stringToDouble(temp_num);
}
else
{dp.mean_x = stringToDouble(temp_num);}
}
is_neg = false;
temp_num.clear();
}

if (cont == 4 && flag_single_read == true)
{
if (line[i] == '-')
{
is_neg = true;
continue;
}
if (line[i] >= '0' && line[i] <= '9')
{
for (size_t j = 0; j < 10; j++)
{ if (line[i+j] >= '0' && line[i+j] <= '9'|| line[i+j] =='.')
{temp_num += line[i + j];}
else break;
}
flag_single_read = false;
if (is_neg == true)
{
dp.mean_y = (-1) * stringToDouble(temp_num);
}
else
{dp.mean_y = stringToDouble(temp_num);}
}
is_neg = false;
temp_num.clear();
}

if (cont == 5 && flag_single_read == true)
{
if (line[i] == '-')
{
is_neg = true;
continue;
}
if (line[i] >= '0' && line[i] <= '9')
{
for (size_t j = 0; j < 10; j++)
{ if (line[i+j] >= '0' && line[i+j] <= '9'|| line[i+j] =='.')
{temp_num += line[i + j];}
else break;
}
flag_single_read = false;
if (is_neg == true)
{
dp.weight_x = (-1) * stringToDouble(temp_num);
}
else
{dp.weight_x = stringToDouble(temp_num);}

}
is_neg = false;
temp_num.clear();
}
if (!file.is_open()) {
std::cerr << "Error opening file: " << filename << std::endl;
return dataPoints;
}

if (cont == 6 && flag_single_read == true)
{
if (line[i] == '-')
{
is_neg = true;
continue;
}
if (line[i] >= '0' && line[i] <= '9')
{
for (size_t j = 0; j < 10; j++)
{ if (line[i+j] >= '0' && line[i+j] <= '9'|| line[i+j] =='.')
{temp_num += line[i + j];}
else break;
} // TODO 验证这里的问题
flag_single_read = false;
if (is_neg == true)
{
dp.weight_y = (-1) * stringToDouble(temp_num);
}
else
{dp.weight_y = stringToDouble(temp_num);}
}
is_neg = false;
temp_num.clear();
break;
while (getline(file, line)) {
std::istringstream iss(line);
std::string part;
DataPoint point;
// 分割行为键值对
while (getline(iss, part, ',')) {
std::istringstream keyValueStream(part);
std::string key;
if (getline(keyValueStream, key, ':')) {
keyValueStream >> std::ws; // 跳过空白字符
if (key.find("posi_ID_x") != std::string::npos) keyValueStream >> point.posi_ID_x;
else if (key.find("posi_ID_y") != std::string::npos) keyValueStream >> point.posi_ID_y;
else if (key.find("mean_x") != std::string::npos) keyValueStream >> point.mean_x;
else if (key.find("mean_y") != std::string::npos) keyValueStream >> point.mean_y;
else if (key.find("weight_x") != std::string::npos) keyValueStream >> point.weight_x;
else if (key.find("weight_y") != std::string::npos) keyValueStream >> point.weight_y;
}
}
dataPoints.push_back(dp);
dataPoints.push_back(point);
}

file.close();
return 0;
return dataPoints;
}

DataPoint find_grid_ID(double x, double y, const std::vector<DataPoint>& dataPoints)
{
DataPoint find_grid_ID(double x, double y, const std::vector<DataPoint> &dataPoints) {

double minDistance = std::numeric_limits<double>::max();
DataPoint nearestGridPoint;

for (const auto& gridPoint : dataPoints) {
for (auto &gridPoint: dataPoints) {
double dist = distance(x, y, gridPoint.mean_x, gridPoint.mean_y);
if (dist < minDistance) {
minDistance = dist;
nearestGridPoint = gridPoint;
}
}
return nearestGridPoint;

}


std::vector<double> interp_1(DataPoint p1, DataPoint p2, double x, double y)
{ std::vector<double> weigh_p1(2), weigh_p2(2), weigh_ans(4); // weigh 向量的前两位分别表示weigh_x 和 weigh_y ，后两位表示x, y点在x = x的直线正交 到 与p1 p2 连线的交点坐标
weigh_p1[0] = p1.weight_x;
Expand Down Expand Up @@ -297,45 +149,38 @@ std::vector<double> Interp_coords(const std::vector<DataPoint> &dataPoints, doub
// 判断四点的构型
DataPoint right_down_point; // 找到序号最小点
int min_cooder = four_point[1].posi_ID_x + four_point[0].posi_ID_y;
for (size_t i = 0; i < 4; i++)
{if (four_point[i].posi_ID_x + four_point[i].posi_ID_y <= min_cooder)
right_down_point = four_point[i];}
for (size_t i = 0; i < 4; i++) {
if (four_point[i].posi_ID_x + four_point[i].posi_ID_y <= min_cooder)
right_down_point = four_point[i];
}
DataPoint left_up_point, left_down_point, right_up_point; // 左上点 右上点 左下点依次找到
for (size_t i = 0; i < 4; i++)
{if (four_point[i].posi_ID_x == right_down_point.posi_ID_x + 1 && four_point[i].posi_ID_y == right_down_point.posi_ID_y)
left_down_point = four_point[i];
if (four_point[i].posi_ID_x == right_down_point.posi_ID_x && four_point[i].posi_ID_y == right_down_point.posi_ID_y + 1)
right_up_point = four_point[i];
if (four_point[i].posi_ID_x == right_down_point.posi_ID_x + 1 && four_point[i].posi_ID_y == right_down_point.posi_ID_y + 1)
left_up_point = four_point[i];}

for (size_t i = 0; i < 4; i++) {
if (four_point[i].posi_ID_x == right_down_point.posi_ID_x + 1 &&
four_point[i].posi_ID_y == right_down_point.posi_ID_y)
left_down_point = four_point[i];
if (four_point[i].posi_ID_x == right_down_point.posi_ID_x &&
four_point[i].posi_ID_y == right_down_point.posi_ID_y + 1)
right_up_point = four_point[i];
if (four_point[i].posi_ID_x == right_down_point.posi_ID_x + 1 &&
four_point[i].posi_ID_y == right_down_point.posi_ID_y + 1)
left_up_point = four_point[i];
}
// 开始插值
std::vector<double> r1(4), r2(4), P(2);
r1 = interp_1(left_up_point, right_up_point, x, y); // 第一次插值输出的结果 向量的前两位表示weigh_x 和 weigh_y ，后两位表示x, y点坐标
r2 = interp_1(left_down_point, right_down_point, x, y);
// P = interp(left_up_point, right_up_point, x, y); // 这里要区分插值方向，第三次是插y值
P = interp_2(r1, r2, x, y);
printf("finished interp");
return P;
P = interp_2(r1, r2, x, y);
printf("finished interp");
return P;
}

int main()
{

// double x = 1.13, y = 0.91;
// double x = 0.56, y = 1.65;
// double x = 0.96, y = 1.19;
// double x = 0.15, y = 2.03;
double x = 1.30, y = 2.19;


extern std::vector<DataPoint> dataPoints;
read_table();
std::vector<double> weigh_out = Interp_coords(dataPoints, x, y);
double x_out = x*weigh_out[0];
double y_out = y*weigh_out[1];

printf("result x:%f y:%f", x_out, y_out);
int main() {
double x = 1.30, y = 2.19;
auto data_vector = readDataPoints("output.txt");
std::vector<double> weigh_out = Interp_coords(data_vector, x, y);
double x_out = x * weigh_out[0];
double y_out = y * weigh_out[1];
printf("result x:%f y:%f", x_out, y_out);
return 0;
}