Revision f150aab5 client/cpp/examples/random_gaze/main.cpp
client/cpp/examples/random_gaze/main.cpp | ||
---|---|---|
1 | 1 |
/* |
2 |
* This file is part of hlrc_client |
|
3 |
* |
|
4 |
* Copyright(c) sschulz <AT> techfak.uni-bielefeld.de |
|
5 |
* http://opensource.cit-ec.de/projects/hlrc_server |
|
6 |
* |
|
7 |
* This file may be licensed under the terms of the |
|
8 |
* GNU General Public License Version 3 (the ``GPL''), |
|
9 |
* or (at your option) any later version. |
|
10 |
* |
|
11 |
* Software distributed under the License is distributed |
|
12 |
* on an ``AS IS'' basis, WITHOUT WARRANTY OF ANY KIND, either |
|
13 |
* express or implied. See the GPL for the specific language |
|
14 |
* governing rights and limitations. |
|
15 |
* |
|
16 |
* You should have received a copy of the GPL along with this |
|
17 |
* program. If not, go to http://www.gnu.org/licenses/gpl.html |
|
18 |
* or write to the Free Software Foundation, Inc., |
|
19 |
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. |
|
20 |
* |
|
21 |
* The development of this software was supported by the |
|
22 |
* Excellence Cluster EXC 277 Cognitive Interaction Technology. |
|
23 |
* The Excellence Cluster EXC 277 is a grant of the Deutsche |
|
24 |
* Forschungsgemeinschaft (DFG) in the context of the German |
|
25 |
* Excellence Initiative. |
|
26 |
* |
|
27 |
*/ |
|
2 |
* This file is part of hlrc_client
|
|
3 |
*
|
|
4 |
* Copyright(c) sschulz <AT> techfak.uni-bielefeld.de
|
|
5 |
* http://opensource.cit-ec.de/projects/hlrc_server
|
|
6 |
*
|
|
7 |
* This file may be licensed under the terms of the
|
|
8 |
* GNU General Public License Version 3 (the ``GPL''),
|
|
9 |
* or (at your option) any later version.
|
|
10 |
*
|
|
11 |
* Software distributed under the License is distributed
|
|
12 |
* on an ``AS IS'' basis, WITHOUT WARRANTY OF ANY KIND, either
|
|
13 |
* express or implied. See the GPL for the specific language
|
|
14 |
* governing rights and limitations.
|
|
15 |
*
|
|
16 |
* You should have received a copy of the GPL along with this
|
|
17 |
* program. If not, go to http://www.gnu.org/licenses/gpl.html
|
|
18 |
* or write to the Free Software Foundation, Inc.,
|
|
19 |
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
|
|
20 |
*
|
|
21 |
* The development of this software was supported by the
|
|
22 |
* Excellence Cluster EXC 277 Cognitive Interaction Technology.
|
|
23 |
* The Excellence Cluster EXC 277 is a grant of the Deutsche
|
|
24 |
* Forschungsgemeinschaft (DFG) in the context of the German
|
|
25 |
* Excellence Initiative.
|
|
26 |
*
|
|
27 |
*/
|
|
28 | 28 |
|
29 | 29 |
#include "RobotController.h" |
30 | 30 |
#include "RobotGaze.h" |
31 | 31 |
#include <unistd.h> |
32 | 32 |
|
33 |
float rand_float(float min, float max){ |
|
34 |
float f = (float)rand() / RAND_MAX;
|
|
35 |
return min + f * (max - min);
|
|
33 |
float rand_float(float min, float max) {
|
|
34 |
float f = (float)rand() / RAND_MAX;
|
|
35 |
return min + f * (max - min);
|
|
36 | 36 |
} |
37 | 37 |
|
38 |
int main (int argc, char **argv){
|
|
39 |
if (argc != 3){
|
|
40 |
printf("usage: %s <middleware> <robot scope>\n", argv[0]);
|
|
41 |
printf(" <middleware> is either ROS or RSB\n");
|
|
42 |
printf(" <robot scope> e.g. /flobi or /icub\n\n"); |
|
43 |
exit(EXIT_FAILURE);
|
|
44 |
}
|
|
38 |
int main(int argc, char** argv) {
|
|
39 |
if (argc != 3) {
|
|
40 |
printf("usage: %s <middleware> <robot scope>\n", argv[0]);
|
|
41 |
printf(" <middleware> is either ROS or RSB\n");
|
|
42 |
printf(" <robot scope> e.g. /flobi or /icub\n\n");
|
|
43 |
exit(EXIT_FAILURE);
|
|
44 |
}
|
|
45 | 45 |
|
46 |
RobotController *robot_controller = new RobotController(argv[1], argv[2]); //"/flobi");
|
|
47 |
//robot_controller->set_current_emotion(RobotEmotion(RobotEmotion::NEUTRAL));
|
|
48 |
RobotGaze gaze;
|
|
46 |
RobotController* robot_controller = new RobotController(argv[1], argv[2]); //"/flobi");
|
|
47 |
// robot_controller->set_current_emotion(RobotEmotion(RobotEmotion::NEUTRAL));
|
|
48 |
RobotGaze gaze;
|
|
49 | 49 |
|
50 |
int count=0;
|
|
50 |
int count = 0;
|
|
51 | 51 |
|
52 |
while(1){
|
|
53 |
if (count++ >= 50){
|
|
54 |
//a new target every second: |
|
55 |
gaze.pan = rand_float(-20.0, 20.0);
|
|
52 |
while (1) {
|
|
53 |
if (count++ >= 50) {
|
|
54 |
// a new target every second:
|
|
55 |
gaze.pan = rand_float(-20.0, 20.0); |
|
56 | 56 |
gaze.tilt = rand_float(-20.0, 20.0); |
57 | 57 |
gaze.roll = 0.0; |
58 | 58 |
gaze.vergence = 0.0; |
59 | 59 |
|
60 |
//absolute mode
|
|
61 |
gaze.gaze_type = RobotGaze::ABSOLUTE;
|
|
62 |
gaze.gaze_timestamp = RobotTimestamp::now();
|
|
60 |
// absolute mode
|
|
61 |
gaze.gaze_type = RobotGaze::ABSOLUTE;
|
|
62 |
gaze.gaze_timestamp = RobotTimestamp::now();
|
|
63 | 63 |
|
64 |
//robot_controller->set_current_emotion(RobotEmotion(RobotEmotion::ANGRY));
|
|
64 |
// robot_controller->set_current_emotion(RobotEmotion(RobotEmotion::ANGRY));
|
|
65 | 65 |
|
66 |
//reset counter |
|
66 |
// reset counter
|
|
67 | 67 |
count = 0; |
68 | 68 |
} |
69 | 69 |
|
70 |
robot_controller->set_gaze_target(gaze); |
|
71 |
usleep(1000/50 * 1000 ); |
|
72 |
} |
|
73 |
|
|
70 |
robot_controller->set_gaze_target(gaze); |
|
71 |
usleep(1000 / 50 * 1000); |
|
72 |
} |
|
74 | 73 |
} |
Also available in: Unified diff