forked from code-iai/knowrob_webtools
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathjson_prolog.js
executable file
·145 lines (132 loc) · 4.36 KB
/
json_prolog.js
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
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
function JsonProlog(ros, options){
var that = this;
this.raw = options.raw || false;
this.finished = false;
var ros = ros;
this.makeid = function() {
var text = "";
var possible = "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789";
for( var i=0; i < 8; i++ )
text += possible.charAt(Math.floor(Math.random() * possible.length));
return text;
};
var qid = that.makeid();
this.jsonQuery = function(query, callback, mode) {
queryMode = mode || 0;
// connect to ROS service
var client = new ROSLIB.Service({
ros : ros,
name : '/json_prolog/simple_query',
serviceType : 'json_prolog/PrologQuery'
});
// send query
var request = new ROSLIB.ServiceRequest({
mode : queryMode, // 1->INCREMENTAL, 0->ALL
id : qid,
query : query
});
client.callService(request, function(result) {
if (result.ok == true) {
that.nextQuery(callback);
}
else {
callback({ status: "QUERY_FAILED", service: "simple_query", error: result });
that.finishClient();
}
}, function(error) {
callback({ status: "QUERY_FAILED", service: "simple_query", error: error });
that.finishClient();
});
};
this.nextQuery = function (callback) {
// connect to ROS service
var client = new ROSLIB.Service({
ros : ros,
name : '/json_prolog/next_solution',
serviceType : 'json_prolog/PrologNextSolution'
});
// send query
var request = new ROSLIB.ServiceRequest({id : qid});
client.callService(request, function(result) {
// status = NO_SOLUTION
if (result.status == 0 && result.solution == "") {
callback({ status: "NO_SOLUTION", completed: true });
that.finishClient();
}
// status = QUERY_FAILED
else if (result.status == 2) {
callback({ status: "QUERY_FAILED", service: "next_solution", error: result });
}
// status = OK
else if (result.status == 3 && result.solution == "{}") {
callback({ status: "OK", completed: true, hasMore: true });
that.finishClient();
}
else if (result.status == 3 && result.solution != "{}") {
var solution = JSON.parse(result.solution);
function parseSolution (solution, level, ret) {
var indent = "";
for (var i = 0; i < level; i++){indent += " "}
for (var key in solution) {
if (solution.hasOwnProperty(key)) {
if (solution[key] instanceof Array || solution[key] instanceof Object) {
ret += indent + key + " = [\n";
ret = parseSolution(solution[key], level + 1, ret);
ret += indent + "]\n"
} else {
ret += indent + key + " = " + solution[key] + "\n";
}
}
}
return ret;
}
if (that.raw == true) {
var ret = solution;
} else {
var ret = parseSolution(solution, 0, "");
}
callback({ value: ret, solution: solution, solution_raw: result.solution });
}
}, function(error) {
callback({ status: "QUERY_FAILED", service: "next_solution", error: error });
that.finishClient();
});
};
this.finishClient = function () {
var client = new ROSLIB.Service({
ros : ros,
name : '/json_prolog/finish',
serviceType : 'json_prolog/PrologFinish'
});
request = new ROSLIB.ServiceRequest({
id : qid
});
client.callService(request, function(e) { });
that.finished = true;
};
this.format = function(result, rdf_namespaces) {
if (result.error) {
console.log("Prolog Query failed: " + result.error.toString());
return (result.error.solution || result.error.message || result.error.toString()) + "\n";
}
else if (result.completed) {
if (result.hasMore) {
return "true.\n\n";
}
else {
return "false.\n\n";
}
}
else {
var value_formatted = result.value;
for(iri in rdf_namespaces) {
// TODO: wrap individual/class name in ''
if(value_formatted.indexOf(iri) !== -1) {
value_formatted = value_formatted.replace(
new RegExp(iri, 'g'), rdf_namespaces[iri]+":");
}
}
return value_formatted;
}
};
}