Diferencia entre revisiones de «OpenMR: Servocontroller examples»
(→Example 2: Set the position of two servos) |
(→Example 2: Set the position of two servos) |
||
Línea 35: | Línea 35: | ||
} | } | ||
− | == | + | == Test-servocontroller-2: Set the position of two servos == |
Example of the '''setpos''' and '''setpos1''' commands to set the position of two servos. Both modul angles are set to 45 and -45 degrees alternatively. | Example of the '''setpos''' and '''setpos1''' commands to set the position of two servos. Both modul angles are set to 45 and -45 degrees alternatively. | ||
Línea 42: | Línea 42: | ||
| [[Imagen:Openmr-test-servocontroller-2-2.jpg|thumb|300px|'''Test-servocontroller-2''': Servo positions set to -45 and 45 degrees (''click to enlarge'')]] | | [[Imagen:Openmr-test-servocontroller-2-2.jpg|thumb|300px|'''Test-servocontroller-2''': Servo positions set to -45 and 45 degrees (''click to enlarge'')]] | ||
|} | |} | ||
+ | |||
+ | In the main loop, the position of the servos is set to 45 and -45 degrees using the '''setpos''' command. | ||
+ | |||
+ | is << "setpos 45 -45 "; | ||
+ | pcontroller->SendCommand(os,is); | ||
+ | sleep(1); | ||
+ | |||
+ | Then, the position is set to -45 and 45 but using the '''setpos1''' command (it can also be used the setpos command, of course) | ||
+ | |||
+ | is << "setpos1 0 -45 "; | ||
+ | pcontroller->SendCommand(os,is); | ||
+ | |||
+ | is << "setpos1 1 45 "; | ||
+ | pcontroller->SendCommand(os,is); | ||
+ | |||
+ | sleep(1); | ||
== Links == | == Links == |
Revisión del 04:02 7 jul 2010
Contenido
Introduction
Test-servocontroller-1: Set the position of one servo
Example of the setpos1 command to set the position of the servo 0. The module's angle is set to 45 and -45 degrees alternatively.
In the begining the environmnet is created (loaded from the file models/Unimod1.env.xml) and the camera view is set. The environment consist of one robot with only one module (Unimod).
First the pointer to the robot(probot) is obtained from the environment (penv). In a general scence, there can be multiple robots. But in this example there is only one robot (robot number 0):
std::vector<RobotBasePtr> robots; penv->GetRobots(robots); RobotBasePtr probot = robots[0];
Then the servocontroller is set as the robot controller:
ControllerBasePtr pcontroller = penv->CreateController("servocontroller"); probot->SetController(pcontroller,"");
In the main loop, the serpos1 command is used to set the module's angle:
while(1) { is << "setpos1 0 45 "; pcontroller->SendCommand(os,is); sleep(1); is << "setpos1 0 -45 "; pcontroller->SendCommand(os,is); sleep(1); }
Test-servocontroller-2: Set the position of two servos
Example of the setpos and setpos1 commands to set the position of two servos. Both modul angles are set to 45 and -45 degrees alternatively.
In the main loop, the position of the servos is set to 45 and -45 degrees using the setpos command.
is << "setpos 45 -45 "; pcontroller->SendCommand(os,is); sleep(1);
Then, the position is set to -45 and 45 but using the setpos1 command (it can also be used the setpos command, of course)
is << "setpos1 0 -45 "; pcontroller->SendCommand(os,is); is << "setpos1 1 45 "; pcontroller->SendCommand(os,is); sleep(1);