Add base manual position update example
This commit is contained in:
parent
668a33a1a1
commit
030bb818e1
|
@ -0,0 +1,93 @@
|
||||||
|
package main
|
||||||
|
|
||||||
|
import (
|
||||||
|
"context"
|
||||||
|
"flag"
|
||||||
|
"log"
|
||||||
|
"time"
|
||||||
|
|
||||||
|
"forge.cadoles.com/Pyxis/orion/emlid"
|
||||||
|
"forge.cadoles.com/Pyxis/orion/emlid/reachview"
|
||||||
|
)
|
||||||
|
|
||||||
|
var (
|
||||||
|
host = "192.168.42.1"
|
||||||
|
)
|
||||||
|
|
||||||
|
func init() {
|
||||||
|
flag.StringVar(&host, "host", host, "ReachRS module host")
|
||||||
|
}
|
||||||
|
|
||||||
|
func main() {
|
||||||
|
|
||||||
|
flag.Parse()
|
||||||
|
|
||||||
|
c := connect()
|
||||||
|
defer c.Close()
|
||||||
|
|
||||||
|
log.Println("updating base manual position")
|
||||||
|
|
||||||
|
// 42["apply configuration",{"base mode":{"base coordinates":{"coordinates":["0","0","0"],"antenna offset":{"up":"0","east":"0","north":"0"},"format":"llh","mode":"fix-and-hold","accumulation":"2"}}}]
|
||||||
|
|
||||||
|
config := &reachview.Configuration{
|
||||||
|
BaseMode: &reachview.BaseMode{
|
||||||
|
BaseCoordinates: &reachview.BaseCoordinates{
|
||||||
|
Coordinates: []*string{
|
||||||
|
reachview.String("2"),
|
||||||
|
reachview.String("0"),
|
||||||
|
reachview.String("0"),
|
||||||
|
},
|
||||||
|
AntennaOffset: &reachview.AntennaOffset{
|
||||||
|
East: reachview.String("0"),
|
||||||
|
North: reachview.String("0"),
|
||||||
|
Up: reachview.String("2"),
|
||||||
|
},
|
||||||
|
Format: reachview.BaseCoordinatesFormatLLH,
|
||||||
|
Mode: reachview.String("manual"),
|
||||||
|
},
|
||||||
|
},
|
||||||
|
}
|
||||||
|
|
||||||
|
applyConfiguration(c, config)
|
||||||
|
|
||||||
|
log.Println("done")
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
func connect() *reachview.Client {
|
||||||
|
|
||||||
|
c := reachview.NewClient(
|
||||||
|
emlid.WithEndpoint(host, 80),
|
||||||
|
)
|
||||||
|
|
||||||
|
log.Printf("connecting to module '%s'", host)
|
||||||
|
if err := c.Connect(); err != nil {
|
||||||
|
log.Fatal(err)
|
||||||
|
}
|
||||||
|
|
||||||
|
log.Println("connected")
|
||||||
|
|
||||||
|
return c
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
func applyConfiguration(c *reachview.Client, config *reachview.Configuration) {
|
||||||
|
|
||||||
|
ctx, applyConfCancel := context.WithTimeout(context.Background(), 20*time.Second)
|
||||||
|
defer applyConfCancel()
|
||||||
|
|
||||||
|
result, _, err := c.ApplyConfiguration(ctx, config)
|
||||||
|
if err != nil {
|
||||||
|
log.Fatal(err)
|
||||||
|
}
|
||||||
|
|
||||||
|
if result != reachview.ConfigurationApplySuccess {
|
||||||
|
log.Fatal("configuration update failed !")
|
||||||
|
}
|
||||||
|
|
||||||
|
log.Println("restarting rtklib")
|
||||||
|
if err := c.RestartRTKLib(); err != nil {
|
||||||
|
log.Fatal(err)
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
Reference in New Issue