Revision f150aab5 client/cpp/examples/random_gaze/main.cpp

View differences:

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