Category:HamsterAPICPPTest - Revision history

Irebot at 08:47, 24 July 2017

2017-07-24T08:47:37Z

Irebot at 08:44, 24 July 2017

2017-07-24T08:44:34Z

Show changes

Irebot at 08:43, 24 July 2017

2017-07-24T08:43:45Z

Irebot at 08:41, 24 July 2017

2017-07-24T08:41:20Z

Irebot at 08:38, 24 July 2017

2017-07-24T08:38:35Z

Irebot at 08:33, 24 July 2017

2017-07-24T08:33:18Z

Irebot at 12:13, 18 July 2017

2017-07-18T12:13:04Z

Irebot: Created page with "== Tests in C++ == How our C++ tests works ? before all test we have to be connected to the Robot so we beginning with the connection. It is necessary to create an object h..."

2017-07-18T12:01:50Z

Created page with "== Tests in C++ == How our C++ tests works ? before all test we have to be connected to the Robot so we beginning with the connection. It is necessary to create an object h..."

New page

== Tests in C++ ==

How our C++ tests works ?

before all test we have to be connected to the Robot so we beginning with the connection.

It is necessary to create an object hamster and it use all information about the Hamster class.
Then we use we create a new HamsterClientParameters. It use to initialize the port and the base address of the Robot.
and now we use the object Hamster that we created before with two parameters :

1- number agent of the robot

2- the name of the HamsterClientParameters that we created before.

We put this little function in a try catch of function with throws exception because if we can't be connected to the robot all the test after will failed.

Example :
<syntaxhighlight lang="bash" line='line'>
HamsterClientParameters params = new HamsterClientParameters();
params.port = 8101;
params.base_address = "10.0.2";
Hamster hamster = new Hamster(1,params);
</syntaxhighlight>

== Test with simulation ==

Before launch our test we have to launch our simulation software Gazebo.

<syntaxhighlight lang="bash" line='line'>
cd hamster_ws
source devel/setup.bash
</syntaxhighlight>

and then launch Gazebo :

<syntaxhighlight lang="bash" line='line'>
roslaunch hamster_api_server_cpp hamster_api_simulation_server_and_gazbo_and_algs.launch
</syntaxhighlight>

For the tests we created a test file where each test corresponds to a function

<syntaxhighlight lang="bash" line='line'>
@Test
public void positionCompareTopics(){
}
</syntaxhighlight>

We have created a function to get the position of the robot and print it as long as we are connected.
In a second time we start the topic on ROS and we compare the values.
The purpose of this test is to verify that the positioning of the robot makes sense.

<syntaxhighlight lang="bash" line='line'>
@Test
public void speedAndPosition(){
}
</syntaxhighlight>

We have created a function that recovers speed and position as long as we are connected to the robot.
The aim of this test is to verify the speed variations of the robots with respect to the position.

<syntaxhighlight lang="bash" line='line'>
@Test
public void navigationTest(){
}
</syntaxhighlight>

We created a function for the robot to navigate from point A to point B.
To be done: <br>
-First define the point A as the initial points and therefore define the initial position.

<syntaxhighlight lang="bash" line='line'>
Pose initial = new pose;
initial.setX(4.0f);
initial.setY(2.0f);
initial.setHeading(120.0f);
hamster.setInitialPose(initial);
</syntaxhighlight>

- In second time set goal to reach with position

<syntaxhighlight lang="bash" line='line'>
Goal goal = new goal;
goal.setX(4.0f);
goal.setY(2.0f);
goal.setHeading(120.0f);
hamster.navigateTo(goal);
</syntaxhighlight>

Between the initial position and the goal we have to insert a thread.sleep().

== Test with robots ==

To make the tests on the robots we use a software allowing us to know all the parameters of the robot such as the position on a map for example.
To launch this software type the following command lines :
<syntaxhighlight lang="bash" line='line'>
export ROS_MASTER_URI=http://10.0.2.1:11311
</syntaxhighlight>
The address after http correspond to the robot's base address.

Now do an ifconfig and find the ip address that has just been added.
<syntaxhighlight lang="bash" line='line'>
ROS_IP=10.0.2. your address
</syntaxhighlight>

And then launch rviz.
<syntaxhighlight lang="bash" line='line'>
rviz
</syntaxhighlight>

To check the communication between two hamster we have developed two programs one for the sending of data and the other for the reception and the answer.<br>
We first run the ReceiveDataMess program before the SendDataMessage program because we need the receiver connected to be able to send a message to it.

=== ReceiveDataMess ===
<syntaxhighlight lang="bash" line='line'>
try
{
// Init the hamster with agent ID number and port
HamsterClientParameters params = new HamsterClientParameters();
params.port = 8108;
params.base_address = "10.0.2";
Hamster hamster = new Hamster(8,params);

while(hamster.isConnected())
{
Log.i("Client", "Waiting for Sender to send msg");

while(!hamster.hasDataMessages())
{
try
{
Thread.sleep(1000);
}
catch (InterruptedException e)
{
continue;
}
}
// print GOT msg
Log.i("Client", "Got msg");

DataMessage msg = hamster.popLatestDataMessage();
Log.i("Client", "" + msg.getSourceAgentID() + "=" + msg.getStringData()); //print ID source = message ex: 7=salut

// create new message to answer to the sender
DataMessage receiver_msg = new DataMessage("coucou",8,7);
Log.i("Client", "Sending Data Message"); // print "sending Data Message"
Log.i("Client", receiver_msg.toString()); // print information about the message
hamster.sendDataMessage(receiver_msg);
}
}

// Connection Issue
catch(HamsterError connection_error)
{
Log.i("Client",connection_error.what());
}
Log.i("Client",connection_error.what());
}
</syntaxhighlight>

=== SendDataMessage ===
<syntaxhighlight lang="bash" line='line'>
try{
// Init the hamster with agent ID number and port
HamsterClientParameters params = new HamsterClientParameters();
params.port = 8107;
params.base_address = "10.0.2";
Hamster hamster = new Hamster(7,params);

while(hamster.isConnected()){

// define a new message "Salut" send by 7 to 8
DataMessage sender_msg = new DataMessage("Salut",7,8);
Log.i("Client", "Sending Data Message");
Log.i("Client", sender_msg.toString());// print "Sending data message" on the console
hamster.sendDataMessage(sender_msg);// we print all information about the message : "Salut" send by 7 to 8

Log.i("Client", "Waiting for Receiver to send msg");

while(!hamster.hasDataMessages())
{
try
{
Thread.sleep(1000);
}
catch (InterruptedException e)
{
continue;
}
}

Log.i("Client", "Got msg"); // print "got message "

DataMessage msg = hamster.popLatestDataMessage();
Log.i("Client", "" + msg.getSourceAgentID() + "=" + msg.getStringData()); // print source ID message = message ex : 8=coucou
}
}
// Connection Issue
catch(HamsterError connection_error)
{
Log.i("Client",connection_error.what());
}
}
</syntaxhighlight>

=== TwoHamsterTwoGoal ===

<syntaxhighlight lang="bash" line='line'>
public class TwoHamsterTwoGoalGlobal {

public static void main(String[] args) {
// TODO Auto-generated method stub

tryThe purpose of this test is to make two hamster go towards a definite goal one after the other.
As long as the first did not reach its goal the second robot does not go towards are objectives.
For this, first we initialize the positions of each robot and then we impose the goal for each of them.
{
// Init hamster with the agent id number and port
HamsterClientParameters params7 = new HamsterClientParameters();
// set port for agent 7
params7.port = 8107;
// set the base address
params7.base_address = "10.0.2";
Hamster hamster7 = new Hamster(7,params7);

HamsterClientParameters params8 = new HamsterClientParameters();
params8.port = 8108;
params8.base_address = "10.0.2";
Hamster hamster8 = new Hamster(8,params8);

if(hamster7.isConnected() && hamster8.isConnected())
{
// if hamster 7 is connected
// DEF Initial position hamster 7 & 8
Pose p = new Pose();
p.setX(5.96f);
p.setY(2.06f);
p.setHeading(-135.0f);
hamster7.setInitialPose(p);
p.setX(7.1f);
p.setY(1.30f);
hamster8.setInitialPose(p);

try {
Thread.sleep(500);
} catch (InterruptedException e) {
// TODO Auto-generated catch block
e.printStackTrace();
}
//just for know if i come inside this if
//System.out.print("---------- Tu passe par la ???? \n");
// goal and navigation for hamster 7

Goal g = new Goal();
// POSITION OF THE GOAL
g.setX(3.55f);
g.setY(-2.44f);
g.setHeading(135.0f);
// GOAL TYPE IS GLOBAL
g.setGoalType(GoalType.GT_GLOBAL_GOAL);
//tell to hamster 7 navigate from initial pose to goal
hamster7.navigateTo(g);

}

// status of navigation hamster 7

while(hamster7.isConnected())
{
// during hamster 7 is connected get the navigation state
NavigationState state = hamster7.getNavigationState();
// if the state is in progress, the navigation continue
if(state.getStatus() == NavigationStatus.NS_IN_PROGRESS)
continue;
else if(state.getStatus() == NavigationStatus.NS_REACHED_GOAL)
{
// if the navigation state is reach so the goal is reach and we disconnect the hamster
Log.i("Client", "Reached Goal : Hamster 7 !");
break;
}
else
{
// else the goal failed and we print it
Log.i("Client", "Goal Failed : Hamster 7 ");
break;
}
}

// deconnection hamster 7
hamster7.disconnect();

if(!hamster7.isConnected() && hamster8.isConnected())
{
// if goal hamster 7 is reach or failed and hamster 8 is conected
// define goal for hamster 8 and navigate to the position

//just for know if i come inside this if
//System.out.print("---------- Tu passe par la ? ");

Goal g = new Goal();
// set the position of the goal for hamster 8
g.setX(4.01f);
g.setY(-0.948f);
g.setHeading(135.0f);
//define type of goal for hamster 8 : global
g.setGoalType(GoalType.GT_GLOBAL_GOAL);
//tell to hamster 8 navigate from initial pose to goal
hamster8.navigateTo(g);
}

try {
Thread.sleep(500);
} catch (InterruptedException e) {
// TODO Auto-generated catch block
e.printStackTrace();
}

while(hamster8.isConnected())
{
// status of navigation Hamster 8
NavigationState state = hamster8.getNavigationState();
// if it's in progress so the hamster continue the navigation
if(state.getStatus() == NavigationStatus.NS_IN_PROGRESS)
continue;
else if(state.getStatus() == NavigationStatus.NS_REACHED_GOAL)
{
// if the navigation state is reach so the goal is reach and we disconnect the hamster
Log.i("Client", "Reached Goal : Hamster 8 !");
break;
}
else
{
// else the goal failed and we print it
Log.i("Client", "Goal Failed : Hamster 8 ");
break;

}
}
// disconnection Hamster 8
hamster8.disconnect();
}
// Connection Issue
catch(HamsterError connection_error)
{
Log.i("Client",connection_error.what());
}
}
}

</syntaxhighlight>

The purpose of this test is to make two hamster go towards a definite goal one after the other.
As long as the first did not reach his goal the second robot does not go towards his objectives.<br>
For this, first we initialize the positions of each robot and then we impose the goal for each of them.

← Older revision		Revision as of 08:47, 24 July 2017
Line 256:		Line 256:
	</syntaxhighlight>		</syntaxhighlight>

		+	For launch correctly our communication between two Hamster we create a file IFDEF.h to launch the receiver before the sender.
		+	<syntaxhighlight lang="bash" line='line'>
		+	*
		+	* IFDEF.h
		+	*
		+	* Created on: Jun 21, 2017
		+	* Author: cogniteam
		+	*
		+
		+	#ifndef IFDEF_H_
		+	#define IFDEF_H_
		+
		+	#define RECEIVER 1
		+	#define SENDER 1
		+
		+	#endif /* IFDEF_H_ */
		+
		+	</syntaxhighlight>
	=== TwoHamsterTwoGoal ===		=== TwoHamsterTwoGoal ===

@@ Line 192: / Line 192: @@
 === SendDataMessage ===
 <syntaxhighlight lang="bash" line='line'>
-try{
-			// Init the hamster with agent ID number and port
+ * HamsterAPIClientDataMessageSender.cpp
-			HamsterClientParameters params = new HamsterClientParameters();
-			params.port = 8107;
+ *  Created on: jun 21, 2016
-			params.base_address = "10.0.2";
+ *      Author: Ilan
-			Hamster hamster = new Hamster(7,params);
-     while(hamster.isConnected()){
+#include <hamster_api_client_cpp/Hamster.h>
-			// define a new message "Salut" send by 7 to 8
+#ifdef SENDER
-			DataMessage sender_msg = new DataMessage("Salut",7,8);
-			Log.i("Client", "Sending Data Message");
+int main(int argc, char ** argv)
-			Log.i("Client", sender_msg.toString());// print "Sending data message" on the console
-			hamster.sendDataMessage(sender_msg);// we print all information about the message : "Salut" send by 7 to 8
+	try
-−
+	{
-			Log.i("Client", "Waiting for Receiver to send msg");
+		HamsterAPI::HamsterClientParameters params;
+		params.port = 8107;
-			while(!hamster.hasDataMessages())
+		params.base_address = "10.0.2";
+			{
-				try
+				HamsterAPI::Log::i("Client", message_error.what());
+			}
-			Log.i("Client", "Got msg"); // print "got message "
+#endif
 </syntaxhighlight>

@@ Line 125: / Line 125: @@
 === ReceiveDataMessage ===
 <syntaxhighlight lang="bash" line='line'>
 try
+		{
-			// Init the hamster with agent ID number and port
+			try
+			{
-				Log.i("Client", "Waiting for Sender to send msg");
+				HamsterAPI::Log::i("Client", "Waiting for Sender to send msg");// print
 				while(!hamster.hasDataMessages())
+					// Thread --> sleep 1
-					try
+					boost::this_thread::sleep(boost::posix_time::milliseconds(1000));
-				DataMessage msg = hamster.popLatestDataMessage();
+				HamsterAPI::Log::i("Client", "Got msg"); // print
-				// create new message to answer to the sender
+				HamsterAPI::DataMessage msg = hamster.popLatestDataMessage();
-				DataMessage receiver_msg = new DataMessage("coucou",8,7);
+				HamsterAPI::Log::i("Client", boost::lexical_cast<std::string>(msg.getSourceAgentID()) + "=" + msg.getStringData());
-				Log.i("Client", "Sending Data Message"); // print "sending Data Message"
-				Log.i("Client", receiver_msg.toString()); // print information about the message
+				// define message of receiver : receiver_msg
 				hamster.sendDataMessage(receiver_msg);
-−
+			}
+			// Message Issue or Connection Issue
+				catch(const HamsterAPI::HamsterError & message_error)
-		// Connection Issue
-		catch(HamsterError connection_error)
+				HamsterAPI::Log::i("Client", message_error.what());
-−
+			}
+		}
-			          Log.i("Client",connection_error.what());
+	// Connection Issue
 </syntaxhighlight>

@@ Line 42: / Line 42: @@
 <syntaxhighlight lang="bash" line='line'>
-@Test
+try
-public void positionCompareTopics(){
+			// define pose like get pose from the robot and print it
 </syntaxhighlight>
@@ Line 51: / Line 60: @@
 The purpose of this test is to verify that the positioning of the robot makes sense.
-<syntaxhighlight lang="bash" line='line'>
 We have created a function that recovers speed and position as long as we are connected to the robot.
 The aim of this test is to verify the speed variations of the robots with respect to the position.
-<syntaxhighlight lang="bash" line='line'>
-@Test
 We created a function for the robot to navigate from point A to point B.
@@ Line 71: / Line 73: @@
 <syntaxhighlight lang="bash" line='line'>
-Pose initial = new pose;
+HamsterAPI::Pose pose;
-initial.setX(4.0f);
+pose.setX(7.03);
-initial.setY(2.0f);
+pose.setY(1.35);
-initial.setHeading(120.0f);
+pose.setHeading(-135.0);
-hamster.setInitialPose(initial);
+hamster.setInitialPose(pose);
 </syntaxhighlight>
@@ Line 81: / Line 83: @@
 <syntaxhighlight lang="bash" line='line'>
-Goal goal = new goal;
+HamsterAPI::Goal goal;
-goal.setX(4.0f);
+goal.setX(3.0);
-goal.setY(2.0f);
+goal.setY(-2.0);
-goal.setHeading(120.0f);
+goal.setHeading(-135.0);
 hamster.navigateTo(goal);
 </syntaxhighlight>

@@ Line 17: / Line 17: @@
 Example :
 <syntaxhighlight lang="bash" line='line'>
-HamsterClientParameters params = new HamsterClientParameters();
+HamsterAPI::HamsterClientParameters params7;
-params.port = 8101;
+params7.port = 8107;
-params.base_address = "10.0.2";
+params7.base_address = "10.0.2";
-Hamster hamster = new Hamster(1,params);
+// Init the agent ID and the port
 </syntaxhighlight>

@@ Line 112: / Line 112: @@
 We first run the ReceiveDataMess program before the SendDataMessage program because we need the receiver connected to be able to send a message to it.
-=== ReceiveDataMess ===
+=== ReceiveDataMessage ===
 <syntaxhighlight lang="bash" line='line'>
 try