Exemplo n.º 1
0
void ControlNode::setTwist(double lx, double ly, double lz,double ax,
                           double ay, double az)
{
    setLinearX(lx);
    setLinearY(ly);
    setLinearZ(lz);
    setAngularX(ax);
    setAngularY(ay);
    setAngularZ(az);
}
Exemplo n.º 2
0
void Irobot::goRobotGo()
{
	setLinearX(0.5);
	setAngularZ(0.0);
	sendCommand();
	usleep(1000000);
	setLinearX(0);
	setAngularZ(2.3);
	sendCommand();
	usleep(1000000);
	setLinearX(0.5);
	setAngularZ(0.0);
	sendCommand();
	usleep(1000000);
	setLinearX(0);
	setAngularZ(2.3);
	sendCommand();
	usleep(1000000);
	setLinearX(0.5);
	setAngularZ(0.0);
	sendCommand();
	usleep(1000000);
	setLinearX(0);
	setAngularZ(2.3);
	sendCommand();
	usleep(1000000);
	setLinearX(0.5);
	setAngularZ(0.0);
	sendCommand();
	usleep(1000000);
	setLinearX(0);
	setAngularZ(2.3);
	sendCommand();
	usleep(1000000);
	setLinearX(0.5);
	setAngularZ(0.0);
	sendCommand();
	usleep(1000000);
}
Exemplo n.º 3
0
void ControlNode::setLinearVector(double x, double y, double z)
{
    setLinearX(x);
    setLinearY(y);
    setLinearZ(z);
}