Astar astar; std::vector<std::vector<Node*>> paths(agvs.size()); // 得到agv的路綫 for (int i = 0; i < agvs.size(); i++) { if (agvs[i].getState() == false) { if (agvs[i].getLoad()){//如果是負載的狀態,則任務的起點到任務的終點 if (agvs[i].getCurrentX() == agvs[i].getEndX() && agvs[i].getCurrentY() == agvs[i].getEndY()) { agvs[i].setState(true); agvs[i].setLoad(false); tasks[i].setCompleted(2); task_to_agv(); } Node* start_node = new Node(agvs[i].getCurrentX(), agvs[i].getCurrentY()); Node* end_node1 = new Node(agvs[i].getEndX(), agvs[i].getEndY()); std::vector<Node*> path_to_end = astar.getPath(start_node, end_node1); path_to_end.erase(path_to_end.begin()); std::vector<Node*> path; path.insert(path.end(), path_to_end.begin(), path_to_end.end()); paths[i] = path;} else { //如果是空載的狀態,則行駛到任務的起點 //如果agv已經到達任務起點,變爲負載狀態 if (agvs[i].getCurrentX() == agvs[i].getStartX() && agvs[i].getCurrentY() == agvs[i].getStartY()) { agvs[i].setLoad(true); } Node* start_node = new Node(agvs[i].getCurrentX(), agvs[i].getCurrentY()); Node* end_node = new Node(agvs[i].getStartX(), agvs[i].getStartY()); std::vector<Node*> path_to_start = astar.getPath(start_node, end_node); std::vector<Node*> path; path.insert(path.end(), path_to_start.begin() + 1, path_to_start.end()); paths[i] = path;} }, if (paths.size() > 0) { std:: cout << "wsn"<<endl; for (int i = 0; i < agvs.size(); i++) { if (!paths[i].empty()) { QPainterPath path; for (int j = 0; j < paths[i].size() - 1; j++) { Node* current_node = paths[i][j]; Node* next_node = paths[i][j+1]; path.moveTo(current_node->x25+200+nodeSize/2, current_node->y25+50+nodeSize/2); path.lineTo(next_node->x25+200+nodeSize/2, next_node->y25+50+nodeSize/2); } painter.setPen(QPen(Qt::yellow, 3)); painter.drawPath(path); } } },沒有畫出agv的路徑,怎麽修改

时间: 2023-11-27 11:54:54 浏览: 32
首先,你可以在绘制路径之前打印出路径的大小,确保路径不为空。如果路径为空,说明 A* 算法没有得到有效的路径,需要检查代码中是否有错误。 其次,在绘制路径时,你可以将路径中的节点坐标转换为绘图坐标。例如,你可以使用以下代码将节点坐标 (x,y) 转换为绘图坐标 (x_draw, y_draw): ```cpp int x_draw = x * nodeSize + 200 + nodeSize/2; int y_draw = y * nodeSize + 50 + nodeSize/2; ``` 其中,`nodeSize` 是每个节点的大小,200 和 50 是绘图区域的偏移量,`nodeSize/2` 是为了将线段的起点和终点放在节点的中心。 最后,你可以尝试调整画笔的颜色和宽度,以便更好地显示路径。例如,你可以使用以下代码将画笔颜色设置为红色,并将宽度设置为 2: ```cpp painter.setPen(QPen(Qt::red, 2)); ``` 综合以上建议,你可以尝试修改代码如下: ```cpp if (!paths[i].empty()) { std::cout << "path size: " << paths[i].size() << std::endl; QPainterPath path; for (int j = 0; j < paths[i].size() - 1; j++) { Node* current_node = paths[i][j]; Node* next_node = paths[i][j+1]; int x1 = current_node->getX(); int y1 = current_node->getY(); int x2 = next_node->getX(); int y2 = next_node->getY(); int x_draw1 = x1 * nodeSize + 200 + nodeSize/2; int y_draw1 = y1 * nodeSize + 50 + nodeSize/2; int x_draw2 = x2 * nodeSize + 200 + nodeSize/2; int y_draw2 = y2 * nodeSize + 50 + nodeSize/2; path.moveTo(x_draw1, y_draw1); path.lineTo(x_draw2, y_draw2); } painter.setPen(QPen(Qt::red, 2)); painter.drawPath(path); } ``` 希望能帮到你!

相关推荐

public: std::vector<std::vector<Node*>> paths;,void MainWindow::moveAgvs() { Astar astar; std::vector<std::vector<Node*>> paths(agvs.size()); //根據agv獲取taskid,初始化 int completed_task_index = -1; // 如果任務都完成了,停止定時器 bool all_tasks_completed = true; for (int j = 0; j < tasks.size(); j++) { if (tasks[j].completed != 2) { all_tasks_completed = false; break; } } if (all_tasks_completed) { timer->stop(); // 停止定时器 return; } // 得到agv的路綫 for (int i = 0; i < agvs.size(); i++) { if (agvs[i].getLoad() == true) { // 如果是负载的状态 if (agvs[i].getCurrentX() == agvs[i].getEndX() && agvs[i].getCurrentY() == agvs[i].getEndY()) { // 如果到达终点 agvs[i].setLoad(false); // 设置为空载状态 agvs[i].setState(true); std::cout << "agv__id :" << agvs[i].getid() << " ,agv_get_task_id :" << agvs[i].get_task_id() << endl; for (int j = 0; j < tasks.size(); j++) { if (tasks[j].id == agvs[i].get_task_id()) { completed_task_index = j; break; } } if (completed_task_index != -1) { tasks[completed_task_index].completed = 2; } task_to_agv(); // 更新任务分配 update(); // 更新AGV状态 } else { // 否则行驶到终点 Node* start_node = new Node(agvs[i].getCurrentX(), agvs[i].getCurrentY()); Node* end_node1 = new Node(agvs[i].getEndX(), agvs[i].getEndY()); std::vector<Node*> path = astar.getPath(start_node, end_node1); path.erase(path.begin()); paths[i] = path; } } else { // 如果是空载的状态 if (agvs[i].getCurrentX() == agvs[i].getStartX() && agvs[i].getCurrentY() == agvs[i].getStartY()) { // 如果到达起点 agvs[i].setLoad(true); // 设置为负载状态 } else { // 否则行驶到起点 Node* start_node = new Node(agvs[i].getCurrentX(), agvs[i].getCurrentY()); Node* end_node = new Node(agvs[i].getStartX(), agvs[i].getStartY()); std::vector<Node*> path = astar.getPath(start_node, end_node); path.erase(path.begin()); paths[i] = path; } } } // for (int i = 0; i < paths.size(); i++) { // std::cout << "AGV " << i << " path: "; // for (int j = 0; j < paths[i].size(); j++) { // std::cout << "(" << paths[i][j]->x << "," << paths[i][j]->y << ") "; // } // std::cout << std::endl; // },爲什麽在其他函數中引用path永遠為空,怎麽修改

void MainWindow::moveAgvs() { Astar astar; std::vector<std::vector<Node*>> agv_paths(agvs.size()); // 将变量名改为 agv_paths //根據agv獲取taskid,初始化 int completed_task_index = -1; // 如果任務都完成了,停止定時器 bool all_tasks_completed = true; for (int j = 0; j < tasks.size(); j++) { if (tasks[j].completed != 2) { all_tasks_completed = false; break; } } if (all_tasks_completed) { timer->stop(); // 停止定时器 return; } // 得到agv的路綫 for (int i = 0; i < agvs.size(); i++) { if (agvs[i].getLoad() == true) { // 如果是负载的状态 if (agvs[i].getCurrentX() == agvs[i].getEndX() && agvs[i].getCurrentY() == agvs[i].getEndY()) { // 如果到达终点 agvs[i].setLoad(false); // 设置为空载状态 agvs[i].setState(true); std::cout << "agv__id :" << agvs[i].getid() << " ,agv_get_task_id :" << agvs[i].get_task_id() << endl; for (int j = 0; j < tasks.size(); j++) { if (tasks[j].id == agvs[i].get_task_id()) { completed_task_index = j; break; } } if (completed_task_index != -1) { tasks[completed_task_index].completed = 2; } task_to_agv(); // 更新任务分配 update(); // 更新AGV状态 } else { // 否则行驶到终点 Node* start_node = new Node(agvs[i].getCurrentX(), agvs[i].getCurrentY()); Node* end_node1 = new Node(agvs[i].getEndX(), agvs[i].getEndY()); std::vector<Node*> path = astar.getPath(start_node, end_node1); path.erase(path.begin()); agv_paths[i] = path; // 将路径保存到 agv_paths 中 } } else { // 如果是空载的状态 if (agvs[i].getCurrentX() == agvs[i].getStartX() && agvs[i].getCurrentY() == agvs[i].getStartY()) { // 如果到达起点 agvs[i].setLoad(true); // 设置为负载状态 } else { // 否则行驶到起点 Node* start_node = new Node(agvs[i].getCurrentX(), agvs[i].getCurrentY()); Node* end_node = new Node(agvs[i].getStartX(), agvs[i].getStartY()); std::vector<Node*> path = astar.getPath(start_node, end_node); path.erase(path.begin()); agv_paths[i] = path; // 将路径保存到 agv_paths 中 } } } // 将 agv_paths 赋值给类成员变量 paths paths = std::vector<std::vector<Node>>(agv_paths.begin(), agv_paths.end()); },paths = std::vector<std::vector<Node>>(agv_paths.begin(), agv_paths.end()); 報錯:沒有可接受的轉換

zip

最新推荐

recommend-type

Maven 下载、安装、配置与使用教程

Maven 下载、安装、配置与使用教程。含maven程序 markdown文本,请使用vscode等代码编辑器查看!!!
recommend-type

起重机械维护保养工艺通则.docx

起重机械维护保养工艺通则.docx
recommend-type

起重机控制部分故障及排除方法表.docx

起重机控制部分故障及排除方法表.docx
recommend-type

试验材料留样期限统计表.docx

试验材料留样期限统计表.docx
recommend-type

龙门吊纠偏装置安装情况调查表.xlsx

龙门吊纠偏装置安装情况调查表.xlsx
recommend-type

zigbee-cluster-library-specification

最新的zigbee-cluster-library-specification说明文档。
recommend-type

管理建模和仿真的文件

管理Boualem Benatallah引用此版本:布阿利姆·贝纳塔拉。管理建模和仿真。约瑟夫-傅立叶大学-格勒诺布尔第一大学,1996年。法语。NNT:电话:00345357HAL ID:电话:00345357https://theses.hal.science/tel-003453572008年12月9日提交HAL是一个多学科的开放存取档案馆,用于存放和传播科学研究论文,无论它们是否被公开。论文可以来自法国或国外的教学和研究机构,也可以来自公共或私人研究中心。L’archive ouverte pluridisciplinaire
recommend-type

优化MATLAB分段函数绘制:提升效率,绘制更快速

![优化MATLAB分段函数绘制:提升效率,绘制更快速](https://ucc.alicdn.com/pic/developer-ecology/666d2a4198c6409c9694db36397539c1.png?x-oss-process=image/resize,s_500,m_lfit) # 1. MATLAB分段函数绘制概述** 分段函数绘制是一种常用的技术,用于可视化不同区间内具有不同数学表达式的函数。在MATLAB中,分段函数可以通过使用if-else语句或switch-case语句来实现。 **绘制过程** MATLAB分段函数绘制的过程通常包括以下步骤: 1.
recommend-type

SDN如何实现简易防火墙

SDN可以通过控制器来实现简易防火墙。具体步骤如下: 1. 定义防火墙规则:在控制器上定义防火墙规则,例如禁止某些IP地址或端口访问,或者只允许来自特定IP地址或端口的流量通过。 2. 获取流量信息:SDN交换机会将流量信息发送给控制器。控制器可以根据防火墙规则对流量进行过滤。 3. 过滤流量:控制器根据防火墙规则对流量进行过滤,满足规则的流量可以通过,不满足规则的流量则被阻止。 4. 配置交换机:控制器根据防火墙规则配置交换机,只允许通过满足规则的流量,不满足规则的流量则被阻止。 需要注意的是,这种简易防火墙并不能完全保护网络安全,只能起到一定的防护作用,对于更严格的安全要求,需要
recommend-type

JSBSim Reference Manual

JSBSim参考手册,其中包含JSBSim简介,JSBSim配置文件xml的编写语法,编程手册以及一些应用实例等。其中有部分内容还没有写完,估计有生之年很难看到完整版了,但是内容还是很有参考价值的。