-
Notifications
You must be signed in to change notification settings - Fork 62
/
main.go
45 lines (39 loc) · 951 Bytes
/
main.go
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
package main
import (
"log"
"os"
"os/signal"
"github.com/bluenviron/goroslib/v2"
"github.com/bluenviron/goroslib/v2/pkg/msgs/sensor_msgs"
)
func onMessage(msg *sensor_msgs.Imu) {
log.Printf("Incoming: %+v\n", msg)
}
func main() {
// create a node and connect to the master
n, err := goroslib.NewNode(goroslib.NodeConf{
Name: "goroslib_sub",
MasterAddress: "127.0.0.1:11311",
})
if err != nil {
panic(err)
}
defer n.Close()
// create a subscriber, use the UDPROS protocol
// the publisher must be based on roscpp or on another implementation that
// supports the protocol. Currently, rospy (python) does not support it.
sub, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
Node: n,
Topic: "test_topic",
Callback: onMessage,
Protocol: goroslib.UDP,
})
if err != nil {
panic(err)
}
defer sub.Close()
// wait for CTRL-C
c := make(chan os.Signal, 1)
signal.Notify(c, os.Interrupt)
<-c
}