-
Notifications
You must be signed in to change notification settings - Fork 0
/
sender.go
99 lines (84 loc) · 1.88 KB
/
sender.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
90
91
92
93
94
95
96
97
98
99
package artnet
import (
"fmt"
"image"
"log"
"net"
"time"
"github.com/jmacd/go-artnet/packet"
"github.com/lucasb-eyer/go-colorful"
)
type (
Sender struct {
destStr string
srcStr string
dest *net.UDPAddr
conn *net.UDPConn
lastLog time.Time
packet.ArtDMXPacket
}
Color = colorful.Color
)
func NewSender(ipAddr string) *Sender {
return &Sender{
destStr: fmt.Sprintf("%s:%d", ipAddr, packet.ArtNetPort),
srcStr: fmt.Sprintf("%s:%d", "", packet.ArtNetPort),
}
}
func (s *Sender) Send(buffer *image.RGBA) error {
err := s.send(buffer)
if err != nil {
now := time.Now()
if now.Sub(s.lastLog) >= time.Second {
log.Printf("send: %v\n", err)
s.lastLog = now
}
}
return err
}
func (s *Sender) send(buffer *image.RGBA) error {
if s.conn == nil {
node, err := net.ResolveUDPAddr("udp", s.destStr)
if err != nil {
return fmt.Errorf("error resolving local udp: %v", err)
}
localAddr, _ := net.ResolveUDPAddr("udp", s.srcStr)
conn, err := net.ListenUDP("udp", localAddr)
if err != nil {
return fmt.Errorf("error resolving artnet udp: %v", err)
}
s.dest = node
s.conn = conn
}
data := s.ArtDMXPacket.Data[:]
s.ArtDMXPacket.SubUni = 0
pixels := buffer.Rect.Dx() * buffer.Rect.Dy()
for p := 0; p < pixels; {
num := maxPerPacket
if pixels-p < num {
num = pixels - p
}
for i := 0; i < num; i++ {
pi := 4 * (p + i)
data[i*3+0] = buffer.Pix[pi+0]
data[i*3+1] = buffer.Pix[pi+1]
data[i*3+2] = buffer.Pix[pi+2]
}
s.ArtDMXPacket.Length = uint16(num * 3)
b, _ := s.ArtDMXPacket.MarshalBinary()
//fmt.Println("Pkt", len(b), "w", num)
if len(b) > maxPacketSize {
panic(fmt.Sprint("wrong size", len(b)))
}
_, err := s.conn.WriteTo(b, s.dest)
if err != nil {
s.conn.Close()
s.conn = nil
s.dest = nil
return fmt.Errorf("error writing packet: %v", err)
}
s.ArtDMXPacket.SubUni++
p += num
}
return nil
}