-
Notifications
You must be signed in to change notification settings - Fork 2
/
Copy pathsolver_state.h
126 lines (80 loc) · 2.13 KB
/
solver_state.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
#include<bits/stdc++.h>
using namespace std;
typedef long long int lli;
#define mod 1000000007
#define F first
#define S second
#define pb push_back
struct Node{
int **scramble;
pair<int,int> blank;
Node *parent;
lli cost;
lli level;
};
Node* newNode(int **puzzle,pair<int,int> blank,pair<int,int> newblank,int level,Node *parent, int N){
Node* state=new Node;
state->parent=parent;
state->scramble=(int **)malloc(N*sizeof(int *));
for(int i=0;i<N;i++)
state->scramble[i]=(int *)malloc(N*sizeof(int));
for(int i=0;i<N;i++){
for(int j=0;j<N;j++)
state->scramble[i][j]=puzzle[i][j];
}
swap(state->scramble[blank.F][blank.S], state->scramble[newblank.F][newblank.S]);
state->blank=newblank;
state->level=level;
state->cost=INT32_MAX;
return state;
}
void printState(int **puzzle, int N){
for(int i=0;i<N;i++){
for(int j=0;j<N;j++)
cout<<puzzle[i][j]<<" ";
cout<<"\n";
}
cout<<"\n";
}
void printPath(Node *root , int N){
if(root==NULL)
return ;
printPath(root->parent,N);
printState(root->scramble,N);
}
long long int heuri_misplaced( int **puzzle, int **sol_puzzle, int N){
//misplaced tiles heuristic
lli bound_lower=0;
for(int i=0;i<N;i++){
for(int j=0;j<N;j++){
if(puzzle[i][j]&&puzzle[i][j]!=sol_puzzle[i][j])
bound_lower++;
}
}
return bound_lower;
}
long long int heuristic( int **puzzle, int **pos, int N){
//manhattan heurestic
int res=0;
for(int i=0;i<N;i++)
{
for(int j=0;j<N;j++)
{
if(puzzle[i][j]!=0){
int val=puzzle[i][j];
res+=abs(i-pos[val][0])+abs(j-pos[val][1]);
}
}
}
return res;
}
struct cmp
{
bool operator()(const Node* lhs, const Node* rhs) const
{
return (lhs->level + lhs->cost ) > (rhs->level + rhs->cost);
}
};
bool safe_check(int x, int y,int N){
return (x>=0 && x< N && y>=0 && y< N);
}