Skip to content

Commit 77bb081

Browse files
author
Borja Outerelo
committed
Merge branch 'feature/examples' into 'develop'
Refs #3333. First commit of the basic examples using strings and int32 See merge request eProsima/micro-ros-demo!1
2 parents 87852ad + 3bb83ff commit 77bb081

12 files changed

Lines changed: 245 additions & 0 deletions

File tree

‎example_publisher/CMakeLists.txt‎

Lines changed: 17 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,17 @@
1+
cmake_minimum_required(VERSION 3.5)
2+
set(CMAKE_CXX_CLANG_TIDY clang-tidy -checks=*)
3+
project(example_publisher)
4+
5+
find_package(ament_cmake REQUIRED)
6+
find_package(rclc REQUIRED)
7+
find_package(std_msgs REQUIRED)
8+
9+
add_executable(example_publisher main.c)
10+
ament_target_dependencies(example_publisher rclc std_msgs)
11+
12+
install(TARGETS
13+
example_publisher
14+
DESTINATION lib/${PROJECT_NAME}
15+
)
16+
17+
ament_package()

‎example_publisher/main.c‎

Lines changed: 35 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,35 @@
1+
#include <rclc/rclc.h>
2+
#include <std_msgs/msg/string.h>
3+
4+
#include <stdio.h>
5+
6+
int main(int argc, char* argv[])
7+
{
8+
(void)argc;
9+
(void)argv;
10+
rclc_init(0, NULL);
11+
rclc_node_t* node = rclc_create_node("publisher_node", "");
12+
rclc_publisher_t* publisher =
13+
rclc_create_publisher(node, RCLC_GET_MSG_TYPE_SUPPORT(std_msgs, msg, String), "publisher_example", 1);
14+
15+
std_msgs__msg__String msg;
16+
char buff[128] = {0};
17+
msg.data.data = buff;
18+
msg.data.capacity = sizeof(buff);
19+
msg.data.size = 0;
20+
21+
int num = 0;
22+
while (rclc_ok())
23+
{
24+
msg.data.size = snprintf(msg.data.data, msg.data.capacity, "Hello World %i", num++);
25+
if (msg.data.size > msg.data.capacity)
26+
msg.data.size = 0;
27+
28+
printf("Sending: '%s'\n", msg.data.data);
29+
rclc_publish(publisher, (const void*)&msg);
30+
rclc_spin_node_once(node, 500);
31+
}
32+
rclc_destroy_publisher(publisher);
33+
rclc_destroy_node(node);
34+
return 0;
35+
}

‎example_publisher/package.xml‎

Lines changed: 16 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,16 @@
1+
<?xml version="1.0"?>
2+
<?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
3+
<package format="3">
4+
<name>example_publisher</name>
5+
<version>0.0.1</version>
6+
<description>Example of a publisher</description>
7+
<maintainer email="borjaouterelo@eprosima.com">borjaouterelo</maintainer>
8+
<license>Apache License 2.0</license>
9+
<buildtool_depend>ament_cmake</buildtool_depend>
10+
<build_depend>rclc</build_depend>
11+
<build_depend>std_msgs</build_depend>
12+
<export>
13+
<build_type>ament_cmake</build_type>
14+
</export>
15+
</package>
16+
Lines changed: 17 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,17 @@
1+
cmake_minimum_required(VERSION 3.5)
2+
set(CMAKE_CXX_CLANG_TIDY clang-tidy -checks=*)
3+
project(example_publisher_int32)
4+
5+
find_package(ament_cmake REQUIRED)
6+
find_package(rclc REQUIRED)
7+
find_package(std_msgs REQUIRED)
8+
9+
add_executable(example_publisher_int32 main.c)
10+
ament_target_dependencies(example_publisher_int32 rclc std_msgs)
11+
12+
install(TARGETS
13+
example_publisher_int32
14+
DESTINATION lib/${PROJECT_NAME}
15+
)
16+
17+
ament_package()

‎example_publisher_int32/main.c‎

Lines changed: 26 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,26 @@
1+
#include <rclc/rclc.h>
2+
#include <std_msgs/msg/int32.h>
3+
4+
#include <stdio.h>
5+
6+
int main(int argc, char *argv[])
7+
{
8+
(void)argc;
9+
(void)argv;
10+
rclc_init(0, NULL);
11+
rclc_node_t* node = rclc_create_node("publisher_node", "");
12+
rclc_publisher_t* publisher = rclc_create_publisher(node, RCLC_GET_MSG_TYPE_SUPPORT(std_msgs, msg, Int32), "publisher_example", 1);
13+
14+
std_msgs__msg__Int32 msg;
15+
msg.data = -1;
16+
17+
while (rclc_ok())
18+
{
19+
printf("Sending: '%i'\n", msg.data++);
20+
rclc_publish(publisher, (const void*)&msg);
21+
rclc_spin_node_once(node, 500);
22+
}
23+
rclc_destroy_publisher(publisher);
24+
rclc_destroy_node(node);
25+
return 0;
26+
}
Lines changed: 16 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,16 @@
1+
<?xml version="1.0"?>
2+
<?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
3+
<package format="3">
4+
<name>example_publisher_int32</name>
5+
<version>0.0.1</version>
6+
<description>Example of a publisher using int32</description>
7+
<maintainer email="borjaouterelo@eprosima.com">borjaouterelo</maintainer>
8+
<license>Apache License 2.0</license>
9+
<buildtool_depend>ament_cmake</buildtool_depend>
10+
<build_depend>rclc</build_depend>
11+
<build_depend>std_msgs</build_depend>
12+
<export>
13+
<build_type>ament_cmake</build_type>
14+
</export>
15+
</package>
16+

‎example_subscriber/CMakeLists.txt‎

Lines changed: 17 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,17 @@
1+
cmake_minimum_required(VERSION 3.5)
2+
set(CMAKE_CXX_CLANG_TIDY clang-tidy -checks=*)
3+
project(example_subscriber)
4+
5+
find_package(ament_cmake REQUIRED)
6+
find_package(rclc REQUIRED)
7+
find_package(std_msgs REQUIRED)
8+
9+
add_executable(example_subscriber main.c)
10+
ament_target_dependencies(example_subscriber rclc std_msgs)
11+
12+
install(TARGETS
13+
example_subscriber
14+
DESTINATION lib/${PROJECT_NAME}
15+
)
16+
17+
ament_package()

‎example_subscriber/main.c‎

Lines changed: 26 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,26 @@
1+
#include <rclc/rclc.h>
2+
#include <std_msgs/msg/string.h>
3+
4+
#include <stdio.h>
5+
6+
void on_message(const void* msgin)
7+
{
8+
const std_msgs__msg__String* msg = (const std_msgs__msg__String*)msgin;
9+
printf("I heard: [%s]\n", msg->data.data);
10+
}
11+
12+
int main(int argc, char* argv[])
13+
{
14+
(void)argc;
15+
(void)argv;
16+
rclc_init(0, NULL);
17+
rclc_node_t* node = rclc_create_node("subscription_node", "");
18+
rclc_subscription_t* sub = rclc_create_subscription(node, RCLC_GET_MSG_TYPE_SUPPORT(std_msgs, msg, String),
19+
"subscription_example", on_message, 1, false);
20+
21+
rclc_spin_node(node);
22+
23+
rclc_destroy_subscription(sub);
24+
rclc_destroy_node(node);
25+
return 0;
26+
}

‎example_subscriber/package.xml‎

Lines changed: 16 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,16 @@
1+
<?xml version="1.0"?>
2+
<?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
3+
<package format="3">
4+
<name>example_subscriber</name>
5+
<version>0.0.1</version>
6+
<description>Example of a subscriber</description>
7+
<maintainer email="borjaouterelo@eprosima.com">borjaouterelo</maintainer>
8+
<license>Apache License 2.0</license>
9+
<buildtool_depend>ament_cmake</buildtool_depend>
10+
<build_depend>rclc</build_depend>
11+
<build_depend>std_msgs</build_depend>
12+
<export>
13+
<build_type>ament_cmake</build_type>
14+
</export>
15+
</package>
16+
Lines changed: 17 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,17 @@
1+
cmake_minimum_required(VERSION 3.5)
2+
set(CMAKE_CXX_CLANG_TIDY clang-tidy -checks=*)
3+
project(example_subscriber_int32)
4+
5+
find_package(ament_cmake REQUIRED)
6+
find_package(rclc REQUIRED)
7+
find_package(std_msgs REQUIRED)
8+
9+
add_executable(example_subscriber_int32 main.c)
10+
ament_target_dependencies(example_subscriber_int32 rclc std_msgs)
11+
12+
install(TARGETS
13+
example_subscriber_int32
14+
DESTINATION lib/${PROJECT_NAME}
15+
)
16+
17+
ament_package()

0 commit comments

Comments
 (0)