int path_finder(int *maze, int rows, int columns, int x1, int y1, int x2, int y2){
if (x1 < 0 || x1 >= rows || y1 < 0 || y1 >= columns || maze[x1 * columns + y1] == 0 || maze[x2 * columns + y2] == 0)
return 0;
if (x1 == x2 && y2 == y1){
return 1;
}
maze[x1 * columns + y1] = 2;
if (x1 + 1 < rows && maze[(x1 + 1) * columns + y1] != 2 && path_finder(maze, rows, columns, x1 + 1, y1, x2, y2) == 1){
maze[(x1 * columns) + y1] = 1;
return 1;
}
else if (y1 + 1 < columns && maze[x1 * columns + y1 + 1] != 2 && path_finder(maze, rows, columns, x1, y1 + 1, x2, y2) == 1) {
maze[(x1 * columns) + y1] = 1;
return 1;
}
else if (y1 - 1 >= 0 && maze[x1 * columns + y1 - 1] != 2 && path_finder(maze, rows, columns, x1, y1 - 1, x2, y2) == 1){
maze[(x1 * columns) + y1] = 1;
return 1;
}
else if (x1 - 1 >= 0 && maze[(x1 - 1) * columns + y1] != 2 && path_finder(maze, rows, columns, x1 - 1, y1, x2, y2) == 1){
maze[(x1 * columns) + y1] = 1;
return 1;
}
else {
maze[(x1 * columns) + y1] = 1;
return 0;
}
}
int main()
{
int n, i, j, t, s, d;
scanf("%d", &n);
int A[n][n];
int D[n];
int P[n];
int color[n];
for(i = 0; i < n; i++) {
for(j = 0; j < n; j++) {
scanf("%d", &A[i][j]);
if (i != j && A[i][j] == 0) {
A[i][j] = 99999;
}
}
}
scanf("%d", &s);
dijkstra(s,n,A,D,P,color);
scanf("%d", &t);
for(i = 0; i < t; i++) {
scanf("%d",&d);
if (D[d - 1] == 99999) {
printf("Path does not exist\n");
continue;
} else if (D[d - 1] == 0){
printf("%d\n", D[d - 1]);
printf("Path does not exist\n");
} else {
printf("%d\n", D[d - 1]);
path_finder(s,d,n,P);
}
}
return 0;
}
int path_exists(int *maze, int rows, int columns, int x1, int y1, int x2, int y2)
{
if (rows*columns*x1*x2*y1*y2 < 0 || checkco(rows,columns,x1,y1)==0 || checkco(rows,columns,x2,y2)==0)
return 0;
else
{
path_finder(maze, rows, columns, x1, x2, y1, y2);
}
}
// ------------------------------------------------------------------------
// window to display an adventure map
// ------------------------------------------------------------------------
void t_adventure_map_window::move_enemy_army( t_army* enemy,
t_adv_map_point const& point )
{
// move enemy to attack
t_adventure_path path;
t_adventure_path_finder path_finder( *m_map );
m_attacking_enemy = enemy;
path_finder.set_army( enemy );
path_finder.set_path_type( k_path_search_enemy_activation );
if (!path_finder.get_path( point, path ))
return;
enemy->set_path( path );
m_map->clear_path();
m_map->clear_selection();
run_object_mover( new t_enemy_army_mover( this, enemy ), false );
}
/*virtual*/
bool ProcessEdge(EdgeId edge) {
TRACE("Considering edge " << graph_.str(edge) << " of length " << graph_.length(edge) << " and avg coverage " << graph_.coverage(edge));
TRACE("Is possible bulge " << PossibleBulgeEdge(edge));
if (!PossibleBulgeEdge(edge)) {
return false;
}
size_t kplus_one_mer_coverage = (size_t) math::round((double) graph_.length(edge) * graph_.coverage(edge));
TRACE("Processing edge " << graph_.str(edge) << " and coverage " << kplus_one_mer_coverage);
size_t delta = CountMaxDifference(max_delta_, graph_.length(edge), max_relative_delta_);
MostCoveredAlternativePathChooser<Graph> path_chooser(graph_, edge);
VertexId start = graph_.EdgeStart(edge);
TRACE("Start " << graph_.str(start));
VertexId end = graph_.EdgeEnd(edge);
TRACE("End " << graph_.str(end));
PathProcessor<Graph> path_finder(graph_, (graph_.length(edge) > delta) ? graph_.length(edge) - delta : 0, graph_.length(edge) + delta, start, end, path_chooser);
path_finder.Process();
const vector<EdgeId>& path = path_chooser.most_covered_path();
double path_coverage = path_chooser.max_coverage();
TRACE("Best path with coverage " << path_coverage << " is " << PrintPath<Graph>(graph_, path));
if (BulgeCondition(edge, path, path_coverage)) {
TRACE("Satisfied condition");
ProcessBulge(edge, path);
return true;
} else {
TRACE("Didn't satisfy condition");
return false;
}
}
int path_exists(int *maze, int rows, int columns, int x1, int y1, int x2, int y2)
{
if (maze == NULL || rows <= 0 || columns <= 0 || x2 < 0 || x2 >= rows || y2 < 0 || y2 >= columns)
return 0;
return path_finder(maze, rows, columns, x1, y1, x2, y2);
}
int main(int argc, char **argv)
{
int n, verbose = 1,
backrow, backcol,
col, row,
len, flag,
srows, scols,
backrow_fd, backcol_fd, path_fd, in_row_fd, in_col_fd, out_fd;
const char *current_mapset,
*search_mapset,
*path_mapset,
*backrow_mapset,
*backcol_mapset, *in_row_file, *in_col_file, *out_file;
CELL *cell;
POINT *PRES_PT, *PRESENT_PT, *OLD_PT;
struct Cell_head window;
double east, north;
struct Option *opt1, *opt2, *opt3, *opt4;
struct Flag *flag1;
struct GModule *module;
G_gisinit(argv[0]);
/* Set description */
module = G_define_module();
G_add_keyword(_("raster"));
G_add_keyword(_("fire"));
G_add_keyword(_("cumulative costs"));
module->description =
_("Recursively traces the least cost path backwards to "
"cells from which the cumulative cost was determined.");
opt1 = G_define_option();
opt1->key = "x_input";
opt1->type = TYPE_STRING;
opt1->required = YES;
opt1->gisprompt = "old,cell,raster";
opt1->description =
_("Name of raster map containing back-path easting information");
opt2 = G_define_option();
opt2->key = "y_input";
opt2->type = TYPE_STRING;
opt2->required = YES;
opt2->gisprompt = "old,cell,raster";
opt2->description =
_("Name of raster map containing back-path northing information");
opt3 = G_define_option();
opt3->key = "coordinate";
opt3->type = TYPE_STRING;
opt3->multiple = YES;
opt3->key_desc = "x,y";
opt3->description =
_("The map E and N grid coordinates of starting points");
opt4 = G_define_option();
opt4->key = "output";
opt4->type = TYPE_STRING;
opt4->required = YES;
opt4->gisprompt = "new,cell,raster";
opt4->description = _("Name of spread path raster map");
flag1 = G_define_flag();
flag1->key = 'v';
flag1->description = _("Run verbosely");
/* Do command line parsing */
if (G_parser(argc, argv))
exit(EXIT_FAILURE);
current_mapset = G_mapset();
in_row_file = G_tempfile();
in_col_file = G_tempfile();
out_file = G_tempfile();
/* Get database window parameters */
G_get_window(&window);
verbose = flag1->answer;
/* Check if backrow layer exists in data base */
search_mapset = "";
strcpy(backrow_layer, opt2->answer);
strcpy(backcol_layer, opt1->answer);
backrow_mapset = G_find_raster(backrow_layer, search_mapset);
backcol_mapset = G_find_raster(backcol_layer, search_mapset);
if (backrow_mapset == NULL)
G_fatal_error("%s - not found", backrow_layer);
if (backcol_mapset == NULL)
G_fatal_error("%s - not found", backcol_layer);
search_mapset = "";
strcpy(path_layer, opt4->answer);
path_mapset = G_find_raster(path_layer, search_mapset);
/* find number of rows and cols in window */
nrows = Rast_window_rows();
ncols = Rast_window_cols();
cell = Rast_allocate_c_buf();
/* Open back cell layers for reading */
backrow_fd = Rast_open_old(backrow_layer, backrow_mapset);
backcol_fd = Rast_open_old(backcol_layer, backcol_mapset);
/* Parameters for map submatrices */
len = sizeof(CELL);
srows = nrows / 4 + 1;
scols = ncols / 4 + 1;
if (verbose)
G_message
("\nReading the input map -%s- and -%s- and creating some temporary files...",
backrow_layer, backcol_layer);
/* Create segmented files for back cell and output layers */
in_row_fd = creat(in_row_file, 0666);
segment_format(in_row_fd, nrows, ncols, srows, scols, len);
close(in_row_fd);
in_col_fd = creat(in_col_file, 0666);
segment_format(in_col_fd, nrows, ncols, srows, scols, len);
close(in_col_fd);
out_fd = creat(out_file, 0666);
segment_format(out_fd, nrows, ncols, srows, scols, len);
close(out_fd);
/* Open initialize and segment all files */
in_row_fd = open(in_row_file, 2);
segment_init(&in_row_seg, in_row_fd, 4);
in_col_fd = open(in_col_file, 2);
segment_init(&in_col_seg, in_col_fd, 4);
out_fd = open(out_file, 2);
segment_init(&out_seg, out_fd, 4);
/* Write the back cell layers in the segmented files, and
* Change UTM coordinates to ROWs and COLUMNs */
for (row = 0; row < nrows; row++) {
Rast_get_c_row(backrow_fd, cell, row);
for (col = 0; col < ncols; col++)
if (cell[col] > 0)
cell[col] =
(window.north - cell[col]) / window.ns_res /* - 0.5 */ ;
else
cell[col] = -1;
segment_put_row(&in_row_seg, cell, row);
Rast_get_c_row(backcol_fd, cell, row);
for (col = 0; col < ncols; col++)
if (cell[col] > 0)
cell[col] =
(cell[col] - window.west) / window.ew_res /* - 0.5 */ ;
segment_put_row(&in_col_seg, cell, row);
}
/* Convert easting and northing from the command line to row and col */
if (opt3->answer) {
for (n = 0; opt3->answers[n] != NULL; n += 2) {
G_scan_easting(opt3->answers[n], &east, G_projection());
G_scan_northing(opt3->answers[n + 1], &north, G_projection());
row = (window.north - north) / window.ns_res;
col = (east - window.west) / window.ew_res;
/* ignore pt outside window */
if (east < window.west || east > window.east ||
north < window.south || north > window.north) {
G_warning("Ignoring point outside window: ");
G_warning(" %.4f,%.4f", east, north);
continue;
}
value = (char *)&backrow;
segment_get(&in_row_seg, value, row, col);
/* ignore pt in no-data area */
if (backrow < 0) {
G_warning("Ignoring point in NO-DATA area :");
G_warning(" %.4f,%.4f", east, north);
continue;
}
value = (char *)&backcol;
segment_get(&in_col_seg, value, row, col);
insert(&PRESENT_PT, row, col, backrow, backcol);
}
}
/* Set flag according to input */
if (path_mapset != NULL) {
if (head_start_pt == NULL)
/*output layer exists and start pts are not given on cmd line */
flag = 1;
/* output layer exists and starting pts are given on cmd line */
else
flag = 2;
}
else
flag = 3; /* output layer does not previously exist */
/* If the output layer containing the starting positions */
/* create a linked list of of them */
if (flag == 1) {
path_fd = Rast_open_old(path_layer, path_mapset);
/* Search for the marked starting pts and make list */
for (row = 0; row < nrows; row++) {
Rast_get_c_row(path_fd, cell, row);
for (col = 0; col < ncols; col++) {
if (cell[col] > 0) {
value = (char *)&backrow;
segment_get(&in_row_seg, value, row, col);
/* ignore pt in no-data area */
if (backrow < 0) {
G_warning("Ignoring point in NO-DATA area:");
G_warning(" %.4f,%.4f\n",
window.west + window.ew_res * (col + 0.5),
window.north - window.ns_res * (row + 0.5));
continue;
}
value = (char *)&backcol;
segment_get(&in_col_seg, value, row, col);
insert(&PRESENT_PT, row, col, backrow, backcol);
}
} /* loop over cols */
} /* loop over rows */
Rast_close(path_fd);
}
/* loop over the starting points to find the least cost paths */
if (verbose)
G_message("\nFinding the least cost paths ...");
PRES_PT = head_start_pt;
while (PRES_PT != NULL) {
path_finder(PRES_PT->row, PRES_PT->col, PRES_PT->backrow,
PRES_PT->backcol);
OLD_PT = PRES_PT;
PRES_PT = NEXT_PT;
G_free(OLD_PT);
}
/* Write pending updates by segment_put() to outputmap */
segment_flush(&out_seg);
if (verbose)
G_message("\nWriting the output map -%s-...", path_layer);
path_fd = Rast_open_c_new(path_layer);
for (row = 0; row < nrows; row++) {
segment_get_row(&out_seg, cell, row);
Rast_put_row(path_fd, cell, CELL_TYPE);
}
if (verbose)
G_message("finished.");
segment_release(&in_row_seg); /* release memory */
segment_release(&in_col_seg);
segment_release(&out_seg);
close(in_row_fd); /* close all files */
close(in_col_fd);
close(out_fd);
Rast_close(path_fd);
Rast_close(backrow_fd);
Rast_close(backcol_fd);
unlink(in_row_file); /* remove submatrix files */
unlink(in_col_file);
unlink(out_file);
exit(EXIT_SUCCESS);
}