Skip to content
GitLab
Menu
Projects
Groups
Snippets
Help
Help
Support
Community forum
Keyboard shortcuts
?
Submit feedback
Contribute to GitLab
Sign in
Toggle navigation
Menu
Open sidebar
Ely Repiso Polo
iri_akp_tools_approaching
Commits
420293f5
Commit
420293f5
authored
May 13, 2019
by
Ely Repiso Polo
Browse files
scenario 9, ok for robot2019 paper
parent
3ea77f66
Changes
1
Hide whitespace changes
Inline
Side-by-side
src/fake_laser_gen_alg_node.cpp
View file @
420293f5
...
...
@@ -173,152 +173,152 @@ void FakeLaserGenAlgNode::node_config_update(Config &config, uint32_t level)
case
FakeLaserGenAlgNode
::
n_obstacles_3
:
// 7!?
ROS_INFO
(
"n obstacles 3"
);
LaserScan_msg_
.
ranges
[
100
]
=
4.0
;
LaserScan_msg_
.
ranges
[
100
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[100+40]= 4.0;
LaserScan_msg_
.
ranges
[
340
]
=
4.0
;
LaserScan_msg_
.
ranges
[
340
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[340+40]= 4.0;
LaserScan_msg_
.
ranges
[
580
]
=
4.0
;
LaserScan_msg_
.
ranges
[
580
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[580+40]= 4.0;
LaserScan_msg_
.
ranges
[
820
]
=
4.0
;
LaserScan_msg_
.
ranges
[
820
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[820+40]= 4.0;
LaserScan_msg_
.
ranges
[
1060
]
=
4.0
;
LaserScan_msg_
.
ranges
[
1060
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[1060+40]= 4.0;
LaserScan_msg_
.
ranges
[
1300
]
=
4.0
;
LaserScan_msg_
.
ranges
[
1300
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[1300+40]= 4.0;
LaserScan_msg_
.
ranges
[
1
]
=
10.0
;
LaserScan_msg_
.
ranges
[
241
]
=
10.0
;
LaserScan_msg_
.
ranges
[
481
]
=
10.0
;
LaserScan_msg_
.
ranges
[
721
]
=
10.0
;
LaserScan_msg_
.
ranges
[
961
]
=
10.0
;
LaserScan_msg_
.
ranges
[
1201
]
=
10.0
;
LaserScan_msg_
.
ranges
[
1
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
241
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
481
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
721
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
961
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
1201
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[1+20]= 10.0;
//
LaserScan_msg_.ranges[241+20]= 10.0;
//
LaserScan_msg_.ranges[481+20]= 10.0;
//
LaserScan_msg_.ranges[721+20]= 10.0;
//
LaserScan_msg_.ranges[961+20]= 10.0;
//
LaserScan_msg_.ranges[1201+20]= 10.0;
break
;
case
FakeLaserGenAlgNode
::
n_obstacles_4
:
// 8!?
ROS_INFO
(
"n obstacles 4"
);
LaserScan_msg_
.
ranges
[
100
]
=
4.0
;
LaserScan_msg_
.
ranges
[
100
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[100+40]= 4.0;
LaserScan_msg_
.
ranges
[
340
]
=
4.0
;
LaserScan_msg_
.
ranges
[
340
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[340+40]= 4.0;
LaserScan_msg_
.
ranges
[
580
]
=
4.0
;
LaserScan_msg_
.
ranges
[
580
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[580+40]= 4.0;
LaserScan_msg_
.
ranges
[
820
]
=
4.0
;
LaserScan_msg_
.
ranges
[
820
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[820+40]= 4.0;
LaserScan_msg_
.
ranges
[
1060
]
=
4.0
;
LaserScan_msg_
.
ranges
[
1060
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[1060+40]= 4.0;
LaserScan_msg_
.
ranges
[
1300
]
=
4.0
;
LaserScan_msg_
.
ranges
[
1300
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[1300+40]= 4.0;
LaserScan_msg_
.
ranges
[
1
]
=
10.0
;
LaserScan_msg_
.
ranges
[
1
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[1+20]= 10.0;
LaserScan_msg_
.
ranges
[
121
]
=
10.0
;
LaserScan_msg_
.
ranges
[
121
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[121+20]= 10.0;
LaserScan_msg_
.
ranges
[
241
]
=
10.0
;
LaserScan_msg_
.
ranges
[
241
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[241+20]= 10.0;
LaserScan_msg_
.
ranges
[
361
]
=
10.0
;
LaserScan_msg_
.
ranges
[
361
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[361+20]= 10.0;
LaserScan_msg_
.
ranges
[
481
]
=
10.0
;
LaserScan_msg_
.
ranges
[
481
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[481+20]= 10.0;
LaserScan_msg_
.
ranges
[
601
]
=
10.0
;
LaserScan_msg_
.
ranges
[
601
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[601+20]= 10.0;
LaserScan_msg_
.
ranges
[
721
]
=
10.0
;
LaserScan_msg_
.
ranges
[
721
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[721+20]= 10.0;
LaserScan_msg_
.
ranges
[
841
]
=
10.0
;
LaserScan_msg_
.
ranges
[
841
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[841+20]= 10.0;
LaserScan_msg_
.
ranges
[
961
]
=
10.0
;
LaserScan_msg_
.
ranges
[
961
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[961+20]= 10.0;
LaserScan_msg_
.
ranges
[
1081
]
=
10.0
;
LaserScan_msg_
.
ranges
[
1081
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[1081+20]= 10.0;
LaserScan_msg_
.
ranges
[
1201
]
=
10.0
;
LaserScan_msg_
.
ranges
[
1201
+
20
]
=
10.0
;
//
LaserScan_msg_.ranges[1201+20]= 10.0;
break
;
case
FakeLaserGenAlgNode
::
n_obstacles_5
:
// 8!?
ROS_INFO
(
"n obstacles 5"
);
LaserScan_msg_
.
ranges
[
100
]
=
4.0
;
LaserScan_msg_
.
ranges
[
100
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[100+40]= 4.0;
LaserScan_msg_
.
ranges
[
340
]
=
4.0
;
LaserScan_msg_
.
ranges
[
340
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[340+40]= 4.0;
LaserScan_msg_
.
ranges
[
580
]
=
4.0
;
LaserScan_msg_
.
ranges
[
580
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[580+40]= 4.0;
LaserScan_msg_
.
ranges
[
820
]
=
4.0
;
LaserScan_msg_
.
ranges
[
820
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[820+40]= 4.0;
LaserScan_msg_
.
ranges
[
1060
]
=
4.0
;
LaserScan_msg_
.
ranges
[
1060
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[1060+40]= 4.0;
LaserScan_msg_
.
ranges
[
1300
]
=
4.0
;
LaserScan_msg_
.
ranges
[
1300
+
40
]
=
4.0
;
//
LaserScan_msg_.ranges[1300+40]= 4.0;
LaserScan_msg_
.
ranges
[
1
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
1
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
121
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
121
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
241
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
241
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
361
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
361
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
481
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
481
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
601
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
601
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
721
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
721
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
841
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
841
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
961
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
961
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
1081
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
1081
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
1201
]
=
10
.0
;
LaserScan_msg_
.
ranges
[
1201
+
20
]
=
10.0
;
LaserScan_msg_
.
ranges
[
1
]
=
7
.0
;
//
LaserScan_msg_.ranges[1+20
10
]= 10.0;
LaserScan_msg_
.
ranges
[
121
]
=
7
.0
;
//
LaserScan_msg_.ranges[121+20]= 10.0;
LaserScan_msg_
.
ranges
[
241
]
=
7
.0
;
//
LaserScan_msg_.ranges[241+20]= 10.0;
LaserScan_msg_
.
ranges
[
361
]
=
7
.0
;
//
LaserScan_msg_.ranges[361+20]= 10.0;
LaserScan_msg_
.
ranges
[
481
]
=
7
.0
;
//
LaserScan_msg_.ranges[481+20]= 10.0;
LaserScan_msg_
.
ranges
[
601
]
=
7
.0
;
//
LaserScan_msg_.ranges[601+20]= 10.0;
LaserScan_msg_
.
ranges
[
721
]
=
7
.0
;
//
LaserScan_msg_.ranges[721+20]= 10.0;
LaserScan_msg_
.
ranges
[
841
]
=
7
.0
;
//
LaserScan_msg_.ranges[841+20]= 10.0;
LaserScan_msg_
.
ranges
[
961
]
=
7
.0
;
//
LaserScan_msg_.ranges[961+20]= 10.0;
LaserScan_msg_
.
ranges
[
1081
]
=
7
.0
;
//
LaserScan_msg_.ranges[1081+20]= 10.0;
LaserScan_msg_
.
ranges
[
1201
]
=
7
.0
;
//
LaserScan_msg_.ranges[1201+20]= 10.0;
LaserScan_msg_
.
ranges
[
50
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
50
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
50
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[50+10]= 15.0;
// LaserScan_msg_.ranges[150]= 15.0;
// LaserScan_msg_.ranges[150+10]= 15.0;
LaserScan_msg_
.
ranges
[
200
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
200
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
200
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[200+10]= 15.0;
// LaserScan_msg_.ranges[250]= 15.0;
// LaserScan_msg_.ranges[250+10]= 15.0;
LaserScan_msg_
.
ranges
[
300
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
300
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
300
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[300+10]= 15.0;
// LaserScan_msg_.ranges[350]= 15.0;
// LaserScan_msg_.ranges[350+10]= 10.0;
LaserScan_msg_
.
ranges
[
400
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
400
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
400
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[400+10]= 15.0;
// LaserScan_msg_.ranges[450]= 15.0;
// LaserScan_msg_.ranges[450+10]= 15.0;
LaserScan_msg_
.
ranges
[
500
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
500
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
500
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[500+10]= 15.0;
// LaserScan_msg_.ranges[550]= 15.0;
// LaserScan_msg_.ranges[550+10]= 15.0;
LaserScan_msg_
.
ranges
[
600
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
600
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
600
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[600+10]= 15.0;
// LaserScan_msg_.ranges[650]= 15.0;
// LaserScan_msg_.ranges[650+10]= 15.0;
LaserScan_msg_
.
ranges
[
700
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
700
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
700
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[700+10]= 15.0;
// LaserScan_msg_.ranges[750]= 15.0;
// LaserScan_msg_.ranges[750+10]= 15.0;
LaserScan_msg_
.
ranges
[
800
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
800
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
800
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[800+10]= 15.0;
// LaserScan_msg_.ranges[850]= 15.0;
// LaserScan_msg_.ranges[850+10]= 15.0;
LaserScan_msg_
.
ranges
[
900
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
900
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
900
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[900+10]= 15.0;
// LaserScan_msg_.ranges[950]= 15.0;
// LaserScan_msg_.ranges[950+10]= 15.0;
LaserScan_msg_
.
ranges
[
1000
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
1000
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
1000
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[1000+10]= 15.0;
// LaserScan_msg_.ranges[1050]= 15.0;
// LaserScan_msg_.ranges[1050+10]= 15.0;
LaserScan_msg_
.
ranges
[
1100
]
=
1
5
.0
;
LaserScan_msg_
.
ranges
[
1100
+
10
]
=
15.0
;
LaserScan_msg_
.
ranges
[
1100
]
=
1
2
.0
;
//
LaserScan_msg_.ranges[1100+10]= 15.0;
// LaserScan_msg_.ranges[1150]= 15.0;
// LaserScan_msg_.ranges[1150+10]= 15.0;
...
...
Write
Preview
Markdown
is supported
0%
Try again
or
attach a new file
.
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment