Aria demo button trigger

#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;
}

Guess you like

Origin http://43.154.161.224:23101/article/api/json?id=324746368&siteId=291194637