#include "Aria.h"
#include "iostream.h"
int main(int argc, char **argv)
{
argc=3;
argv[0]="";
argv[1]="-rp";
argv[2]="COM9";
int x=0, y=0, z=0, v=0, LS=0, RS=0, in=0;
Aria::init();
ArArgumentParser parser(&argc, argv);
parser.loadDefaultArguments();
ArRobot robot;
ArRobotConnector robotConnector(&parser, &robot);
robotConnector.connectRobot();
robot.enableMotors();
robot.runAsync(true);
//robot.lock();
//robot.setVel2(LS,RS);
//robot.unlock();
while(1)
{
std::cin>>in;
if(in==1)
{
LS=200;
RS=200;
}
if(in==2)
{
LS=-200;
RS=-200;
}
if(in==3)
{
LS=60;
RS=-60;
}
if(in==4)
{
LS=-60;
RS=60;
}
if(in==5)
{
LS=0;
RS=0;
}
robot.lock();
robot.setVel2(LS,RS);
x=robot.getX();
y=robot.getY();
z=robot.getTh();
v=robot.getVel();
robot.unlock();
printf("X: %d\r\n",x);
printf("Y: %d\r\n",y);
printf("Th: %d\r\n",z);
printf("Velocity: %d\r\n",v);
ArUtil::sleep(100);
}
//ArUtil::sleep(3000);
//robot.waitForRunExit();
Aria::exit(0);
return 0;
}
Aria demo button trigger
Guess you like
Origin http://43.154.161.224:23101/article/api/json?id=324746368&siteId=291194637
Ranking