forked from alexbeltran/gobacnet
-
Notifications
You must be signed in to change notification settings - Fork 1
/
writemulti.go
86 lines (73 loc) · 2.11 KB
/
writemulti.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
package gobacnet
import (
"context"
"fmt"
"time"
"github.com/alexbeltran/gobacnet/encoding"
bactype "github.com/alexbeltran/gobacnet/types"
)
func (c *client) WriteMultiProperty(dev bactype.Device, wp bactype.MultiplePropertyData) error {
ctx, cancel := context.WithTimeout(context.Background(), time.Second)
defer cancel()
id, err := c.tsm.ID(ctx)
if err != nil {
return fmt.Errorf("unable to get an transaction id: %v", err)
}
defer c.tsm.Put(id)
npdu := &bactype.NPDU{
Version: bactype.ProtocolVersion,
Destination: &dev.Addr,
Source: c.dataLink.GetMyAddress(),
IsNetworkLayerMessage: false,
ExpectingReply: true,
Priority: bactype.Normal,
HopCount: bactype.DefaultHopCount,
}
enc := encoding.NewEncoder()
enc.NPDU(npdu)
enc.WriteMultiProperty(uint8(id), wp)
if enc.Error() != nil {
return enc.Error()
}
pack := enc.Bytes()
if dev.MaxApdu < uint32(len(pack)) {
return fmt.Errorf("read multiple property is too large (max: %d given: %d)", dev.MaxApdu, len(pack))
}
// the value filled doesn't matter. it just needs to be non nil
err = fmt.Errorf("go")
for count := 0; err != nil && count < maxReattempt; count++ {
err = c.sendWriteMultipleProperty(id, dev, npdu, pack)
if err == nil {
return nil
}
}
return fmt.Errorf("failed %d tries: %v", maxReattempt, err)
}
func (c *client) sendWriteMultipleProperty(id int, dev bactype.Device, npdu *bactype.NPDU, request []byte) error {
_, err := c.Send(dev.Addr, npdu, request)
if err != nil {
return err
}
raw, err := c.tsm.Receive(id, time.Duration(5)*time.Second)
if err != nil {
return fmt.Errorf("unable to receive id %d: %v", id, err)
}
var b []byte
switch v := raw.(type) {
case error:
return v
case []byte:
b = v
default:
return fmt.Errorf("received unknown datatype %T", raw)
}
dec := encoding.NewDecoder(b)
var apdu bactype.APDU
if err = dec.APDU(&apdu); err != nil {
return err
}
if apdu.Error.Class != 0 || apdu.Error.Code != 0 {
return fmt.Errorf("received error, class: %d, code: %d", apdu.Error.Class, apdu.Error.Code)
}
return nil
}