-
Notifications
You must be signed in to change notification settings - Fork 62
/
main.go
89 lines (74 loc) · 1.61 KB
/
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
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
package main
import (
"log"
"os"
"os/signal"
"github.com/bluenviron/goroslib/v2"
"github.com/bluenviron/goroslib/v2/pkg/msg"
)
// define a custom action.
// unlike the standard library, an .action file is not needed.
type DoSomethingActionGoal struct {
Input uint32
}
type DoSomethingActionResult struct {
Output uint32
}
type DoSomethingActionFeedback struct {
PercentComplete float32
}
type DoSomethingAction struct {
msg.Package `ros:"shared_actions"`
DoSomethingActionGoal
DoSomethingActionResult
DoSomethingActionFeedback
}
func main() {
// create a node and connect to the master
n, err := goroslib.NewNode(goroslib.NodeConf{
Namespace: "/myns",
Name: "goroslib",
MasterAddress: "127.0.0.1:11311",
})
if err != nil {
panic(err)
}
defer n.Close()
// create a simple action client
sac, err := goroslib.NewSimpleActionClient(goroslib.SimpleActionClientConf{
Node: n,
Name: "test_action",
Action: &DoSomethingAction{},
})
if err != nil {
panic(err)
}
defer sac.Close()
// wait for the server
sac.WaitForServer()
done := make(chan struct{})
// send a goal
err = sac.SendGoal(goroslib.SimpleActionClientGoalConf{
Goal: &DoSomethingActionGoal{
Input: 1234312,
},
OnDone: func(state goroslib.SimpleActionClientGoalState, res *DoSomethingActionResult) {
log.Println("result:", res)
close(done)
},
OnFeedback: func(fb *DoSomethingActionFeedback) {
log.Println("feedback", fb)
},
})
if err != nil {
panic(err)
}
c := make(chan os.Signal, 1)
signal.Notify(c, os.Interrupt)
select {
// goal is done
case <-done:
// handle CTRL-C
case <-c:
}
}