| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406 |
- package binary
- import (
- "fmt"
- "io"
- "strings"
- "git.bobomao.top/joey/testwh/binary/token"
- "git.bobomao.top/joey/testwh/types"
- )
- type binaryDecoder struct {
- data []byte
- index int
- }
- func newDecoder(data []byte) *binaryDecoder {
- return &binaryDecoder{data, 0}
- }
- func (r *binaryDecoder) checkEOS(length int) error {
- if r.index+length > len(r.data) {
- return io.EOF
- }
- return nil
- }
- func (r *binaryDecoder) readByte() (byte, error) {
- if err := r.checkEOS(1); err != nil {
- return 0, err
- }
- b := r.data[r.index]
- r.index++
- return b, nil
- }
- func (r *binaryDecoder) readIntN(n int, littleEndian bool) (int, error) {
- if err := r.checkEOS(n); err != nil {
- return 0, err
- }
- var ret int
- for i := 0; i < n; i++ {
- var curShift int
- if littleEndian {
- curShift = i
- } else {
- curShift = n - i - 1
- }
- ret |= int(r.data[r.index+i]) << uint(curShift*8)
- }
- r.index += n
- return ret, nil
- }
- func (r *binaryDecoder) readInt8(littleEndian bool) (int, error) {
- return r.readIntN(1, littleEndian)
- }
- func (r *binaryDecoder) readInt16(littleEndian bool) (int, error) {
- return r.readIntN(2, littleEndian)
- }
- func (r *binaryDecoder) readInt20() (int, error) {
- if err := r.checkEOS(3); err != nil {
- return 0, err
- }
- ret := ((int(r.data[r.index]) & 15) << 16) + (int(r.data[r.index+1]) << 8) + int(r.data[r.index+2])
- r.index += 3
- return ret, nil
- }
- func (r *binaryDecoder) readInt32(littleEndian bool) (int, error) {
- return r.readIntN(4, littleEndian)
- }
- func (r *binaryDecoder) readPacked8(tag int) (string, error) {
- startByte, err := r.readByte()
- if err != nil {
- return "", err
- }
- var build strings.Builder
- for i := 0; i < int(startByte&127); i++ {
- currByte, err := r.readByte()
- if err != nil {
- return "", err
- }
- lower, err := unpackByte(tag, currByte&0xF0>>4)
- if err != nil {
- return "", err
- }
- upper, err := unpackByte(tag, currByte&0x0F)
- if err != nil {
- return "", err
- }
- build.WriteByte(lower)
- build.WriteByte(upper)
- }
- ret := build.String()
- if startByte>>7 != 0 {
- ret = ret[:len(ret)-1]
- }
- return ret, nil
- }
- func unpackByte(tag int, value byte) (byte, error) {
- switch tag {
- case token.Nibble8:
- return unpackNibble(value)
- case token.Hex8:
- return unpackHex(value)
- default:
- return 0, fmt.Errorf("unpackByte with unknown tag %d", tag)
- }
- }
- func unpackNibble(value byte) (byte, error) {
- switch {
- case value < 10:
- return '0' + value, nil
- case value == 10:
- return '-', nil
- case value == 11:
- return '.', nil
- case value == 15:
- return 0, nil
- default:
- return 0, fmt.Errorf("unpackNibble with value %d", value)
- }
- }
- func unpackHex(value byte) (byte, error) {
- switch {
- case value < 10:
- return '0' + value, nil
- case value < 16:
- return 'A' + value - 10, nil
- default:
- return 0, fmt.Errorf("unpackHex with value %d", value)
- }
- }
- func (r *binaryDecoder) readListSize(tag int) (int, error) {
- switch tag {
- case token.ListEmpty:
- return 0, nil
- case token.List8:
- return r.readInt8(false)
- case token.List16:
- return r.readInt16(false)
- default:
- return 0, fmt.Errorf("readListSize with unknown tag %d at position %d", tag, r.index)
- }
- }
- func (r *binaryDecoder) read(string bool) (interface{}, error) {
- tagByte, err := r.readByte()
- if err != nil {
- return nil, err
- }
- tag := int(tagByte)
- switch tag {
- case token.ListEmpty:
- return nil, nil
- case token.List8, token.List16:
- return r.readList(tag)
- case token.Binary8:
- size, err := r.readInt8(false)
- if err != nil {
- return nil, err
- }
- return r.readBytesOrString(size, string)
- case token.Binary20:
- size, err := r.readInt20()
- if err != nil {
- return nil, err
- }
- return r.readBytesOrString(size, string)
- case token.Binary32:
- size, err := r.readInt32(false)
- if err != nil {
- return nil, err
- }
- return r.readBytesOrString(size, string)
- case token.Dictionary0, token.Dictionary1, token.Dictionary2, token.Dictionary3:
- i, err := r.readInt8(false)
- if err != nil {
- return "", err
- }
- return token.GetDoubleToken(tag-token.Dictionary0, i)
- case token.FBJID:
- return r.readFBJID()
- case token.InteropJID:
- return r.readInteropJID()
- case token.JIDPair:
- return r.readJIDPair()
- case token.ADJID:
- return r.readADJID()
- case token.Nibble8, token.Hex8:
- return r.readPacked8(tag)
- default:
- if tag >= 1 && tag < len(token.SingleByteTokens) {
- return token.SingleByteTokens[tag], nil
- }
- return "", fmt.Errorf("%w %d at position %d", ErrInvalidToken, tag, r.index)
- }
- }
- func (r *binaryDecoder) readJIDPair() (interface{}, error) {
- user, err := r.read(true)
- if err != nil {
- return nil, err
- }
- server, err := r.read(true)
- if err != nil {
- return nil, err
- } else if server == nil {
- return nil, ErrInvalidJIDType
- } else if user == nil {
- return types.NewJID("", server.(string)), nil
- }
- return types.NewJID(user.(string), server.(string)), nil
- }
- func (r *binaryDecoder) readInteropJID() (interface{}, error) {
- user, err := r.read(true)
- if err != nil {
- return nil, err
- }
- device, err := r.readInt16(false)
- if err != nil {
- return nil, err
- }
- integrator, err := r.readInt16(false)
- if err != nil {
- return nil, err
- }
- server, err := r.read(true)
- if err != nil {
- return nil, err
- } else if server != types.InteropServer {
- return nil, fmt.Errorf("%w: expected %q, got %q", ErrInvalidJIDType, types.InteropServer, server)
- }
- return types.JID{
- User: user.(string),
- Device: uint16(device),
- Integrator: uint16(integrator),
- Server: types.InteropServer,
- }, nil
- }
- func (r *binaryDecoder) readFBJID() (interface{}, error) {
- user, err := r.read(true)
- if err != nil {
- return nil, err
- }
- device, err := r.readInt16(false)
- if err != nil {
- return nil, err
- }
- server, err := r.read(true)
- if err != nil {
- return nil, err
- } else if server != types.MessengerServer {
- return nil, fmt.Errorf("%w: expected %q, got %q", ErrInvalidJIDType, types.MessengerServer, server)
- }
- return types.JID{
- User: user.(string),
- Device: uint16(device),
- Server: server.(string),
- }, nil
- }
- func (r *binaryDecoder) readADJID() (interface{}, error) {
- agent, err := r.readByte()
- if err != nil {
- return nil, err
- }
- device, err := r.readByte()
- if err != nil {
- return nil, err
- }
- user, err := r.read(true)
- if err != nil {
- return nil, err
- }
- return types.NewADJID(user.(string), agent, device), nil
- }
- func (r *binaryDecoder) readAttributes(n int) (Attrs, error) {
- if n == 0 {
- return nil, nil
- }
- ret := make(Attrs)
- for i := 0; i < n; i++ {
- keyIfc, err := r.read(true)
- if err != nil {
- return nil, err
- }
- key, ok := keyIfc.(string)
- if !ok {
- return nil, fmt.Errorf("%[1]w at position %[3]d (%[2]T): %+[2]v", ErrNonStringKey, key, r.index)
- }
- ret[key], err = r.read(true)
- if err != nil {
- return nil, err
- }
- }
- return ret, nil
- }
- func (r *binaryDecoder) readList(tag int) ([]Node, error) {
- size, err := r.readListSize(tag)
- if err != nil {
- return nil, err
- }
- ret := make([]Node, size)
- for i := 0; i < size; i++ {
- n, err := r.readNode()
- if err != nil {
- return nil, err
- }
- ret[i] = *n
- }
- return ret, nil
- }
- func (r *binaryDecoder) readNode() (*Node, error) {
- ret := &Node{}
- size, err := r.readInt8(false)
- if err != nil {
- return nil, err
- }
- listSize, err := r.readListSize(size)
- if err != nil {
- return nil, err
- }
- rawDesc, err := r.read(true)
- if err != nil {
- return nil, err
- }
- ret.Tag = rawDesc.(string)
- if listSize == 0 || ret.Tag == "" {
- return nil, ErrInvalidNode
- }
- ret.Attrs, err = r.readAttributes((listSize - 1) >> 1)
- if err != nil {
- return nil, err
- }
- if listSize%2 == 1 {
- return ret, nil
- }
- ret.Content, err = r.read(false)
- return ret, err
- }
- func (r *binaryDecoder) readBytesOrString(length int, asString bool) (interface{}, error) {
- data, err := r.readRaw(length)
- if err != nil {
- return nil, err
- }
- if asString {
- return string(data), nil
- }
- return data, nil
- }
- func (r *binaryDecoder) readRaw(length int) ([]byte, error) {
- if err := r.checkEOS(length); err != nil {
- return nil, err
- }
- ret := r.data[r.index : r.index+length]
- r.index += length
- return ret, nil
- }
|