forked from qaz9877/go-smpp
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathmarshal.go
123 lines (119 loc) · 2.63 KB
/
marshal.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
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
package pdu
import (
"bufio"
"bytes"
"encoding/binary"
"io"
"reflect"
)
func unmarshal(r io.Reader, packet any) (n int64, err error) {
buf := bufio.NewReader(r)
v := reflect.ValueOf(packet)
if v.Kind() == reflect.Ptr {
v = v.Elem()
}
for i := 0; i < v.NumField(); i++ {
switch field := v.Field(i); field.Kind() {
case reflect.String:
var value string
if value, err = readCString(buf); err == nil {
field.SetString(value)
}
case reflect.Uint8:
var value byte
if value, err = buf.ReadByte(); err == nil {
field.SetUint(uint64(value))
}
case reflect.Bool:
var value byte
if value, err = buf.ReadByte(); err == nil {
field.SetBool(value == 1)
}
case reflect.Array, reflect.Map, reflect.Slice, reflect.Struct:
switch v := (field.Addr().Interface()).(type) {
case *Header:
err = readHeaderFrom(buf, v)
if v.CommandStatus != 0 {
return
}
case io.ByteWriter:
var value byte
if value, err = buf.ReadByte(); err == nil {
err = v.WriteByte(value)
}
case io.ReaderFrom:
if m, ok := v.(*ShortMessage); ok {
m.Prepare(packet)
}
_, err = v.ReadFrom(buf)
}
}
n = int64(buf.Size())
if err != nil {
err = ErrUnmarshalPDUFailed
return
}
}
return
}
func Marshal(w io.Writer, packet any) (n int64, err error) {
var buf bytes.Buffer
p := reflect.ValueOf(packet)
if p.Kind() == reflect.Ptr {
p = p.Elem()
}
for i := 0; i < p.NumField(); i++ {
field := p.Field(i)
switch field.Kind() {
case reflect.String:
writeCString(&buf, field.String())
case reflect.Uint8:
buf.WriteByte(byte(field.Uint()))
case reflect.Bool:
var value byte
if field.Bool() {
value = 1
}
buf.WriteByte(value)
case reflect.Array, reflect.Map, reflect.Slice, reflect.Struct:
switch v := field.Addr().Interface().(type) {
case *Header:
v.CommandID = findCommandID(p.Type())
if err == nil && v.Sequence > 0 {
_ = binary.Write(&buf, binary.BigEndian, v)
} else {
err = ErrInvalidSequence
}
if v.CommandStatus != 0 {
goto write
}
case io.ByteReader:
var value byte
value, err = v.ReadByte()
buf.WriteByte(value)
case io.WriterTo:
if m, ok := v.(*ShortMessage); ok {
m.Prepare(packet)
}
_, err = v.WriteTo(&buf)
}
}
if err != nil {
return
}
}
write:
if p.Field(0).Type() == reflect.TypeOf(Header{}) {
data := buf.Bytes()
binary.BigEndian.PutUint32(data[0:4], uint32(buf.Len()))
}
return buf.WriteTo(w)
}
func findCommandID(target reflect.Type) CommandID {
for id, t := range types {
if target == t {
return id
}
}
panic("unregistered command id")
}