Backup of Joystick service(No. 4)

List of Backups
View the diff.
View the diff current.
View the source.
Go to Joystick service.
- 1 (2013-09-04 (Wed) 17:15:05)
- 2 (2013-09-04 (Wed) 17:42:05)
- 3 (2013-09-04 (Wed) 20:44:32)
- 4 (2013-09-05 (Thu) 15:23:06)
- 5 (2013-11-29 (Fri) 22:53:56)
- 6 (2014-02-06 (Thu) 13:30:08)

Tutorial?

The aim of this tutorial is to introduce how to control a SIGVerse robot using Joystick. The example below allows to control a robot in 4 directions: moving forward, backward, turning left and right.

Installation of the joystick
Controller
Service
World file
Download the project

Installation of the joystick †

Download and install Microsoft directx sdk

↑

Controller †

The controller receives data from the joystick service as messages using the joystick, sets the corresponding velocity then sends the command to the robot.

joystick.cpp:

#include "Controller.h"
#include "Logger.h"
#include <unistd.h>
#include "ControllerEvent.h"
#include <sstream>
class voiceRecognition : public Controller
{
public:
void onInit(InitEvent &evt);
double onAction(ActionEvent &evt);
void onRecvMsg(RecvMsgEvent &evt);
public:
RobotObj *my;
double velocity;
int i;
double direction1;
double direction2;
int j;
double Weel_one;
double Weel_two;
};
void voiceRecognition::onInit(InitEvent &evt)
{
Weel_one = 0.0;
Weel_two = 0.0;
my = this->getRobotObj(this->myname());
my->setWheel(10.0, 10.0);
}
double voiceRecognition::onAction(ActionEvent &evt)
{
my->setWheelVelocity(Weel_one,Weel_two);
return 0.01;
}
void voiceRecognition::onRecvMsg(RecvMsgEvent &evt)
{
std::string sender = evt.getSender();
std::string msg = evt.getMsg();
LOG_MSG(("message : %s", msg.c_str()));
if(strcmp("moveforward",msg.c_str())==0)
{
Weel_one = 3.0;
Weel_two = 3.0;
}
else if(strcmp("movebackward",msg.c_str())==0)
{
Weel_one = -3.0;
Weel_two = -3.0;
}
else if(strcmp("turnleft",msg.c_str())==0)
{
Weel_one = -0.78;
Weel_two = 0.78;
}
else if(strcmp("turnright",msg.c_str())==0)
{
Weel_one = 0.78;
Weel_two = -0.78;
}    
}
extern "C"  Controller * createController ()
{
return new voiceRecognition;
}

↑

Service †

The service receives data from the joystick, for each button of the joystick corresponds an action, the allowed actions are: move forward, move backward, turn left and turn right, when a button is pressed, the appropriate message is sent to the controller to move the robot.

Joystick_Service.cpp

#include <tchar.h>
#include <string>
#include <iostream>
#include < fstream>
#include "SIGService.h"
#include <windows.h>
#include "Joystick_Driver.h"

bool Proceed = false;
bool lancer = false;

class Joystick_Service : public sigverse::SIGService
{

public:
	Joystick_Service(std::string name);
	~Joystick_Service();
    double onAction();
	void onRecvMsg(sigverse::RecvMsgEvent &evt);
private: Joystick*  JS; //pointer to joystick object
private: HWND hWnd;	
};

Joystick_Service::Joystick_Service(std::string name) : SIGService(name){

JS = new Joystick();
            hWnd = NULL;
	};

Joystick_Service::~Joystick_Service()
{
	this->disconnect();
}

double Joystick_Service::onAction()
{
    JS->runJoystick(hWnd);
	printf("moveforward message        : %d\n",JS->getButton(0));
	printf("movebackward message      : %d\n",JS->getButton(1));
	printf("turnleft message      : %d\n",JS->getButton(2));
	printf("turnright message     : %d\n",JS->getButton(3));

if(JS->getButton(0))
	{
this->sendMsg("robot_000","moveforward");
	}
	if(JS->getButton(1))
	{
this->sendMsg("robot_000","movebackward");

}
	if(JS->getButton(2))
	{
this->sendMsg("robot_000","turnright");

}

if(JS->getButton(3))
	{
this->sendMsg("robot_000","turnleft");

}

return 0.1;
}

void Joystick_Service::onRecvMsg(sigverse::RecvMsgEvent &evt)
{
   
}
int main(int argc, char** argv)
{
	Joystick_Service srv("Joystick__Service");
	unsigned short port = (unsigned short)(atoi(argv[2]));
	srv.connect(argv[1], port);
	srv.startLoop();
	return 0;
}

To download the plugin:

Sig_Joystick.sig

↑

World file †

joystickWorld.xml

<?xml version="1.0" encoding="utf-8"?>
<world name="myworld1">
  <gravity x="0.0" y="-980.7" z="0.0"/>

↑

Download the project †

To download the project from GIT repository, use the following link:

git@socio4.iir.nii.ac.jp:~/SigverseGitServer/unstable/usersContribution/tafifet/joystick_service.git

Backup of Joystick service (No. 4)

Installation of the joystick †

Controller †

Service †

World file †

Download the project †