284 lines
7.7 KiB
Go
284 lines
7.7 KiB
Go
// Copyright 2015 Tony Bai.
|
|
//
|
|
// Licensed under the Apache License, Version 2.0 (the "License");
|
|
// you may not use this file except in compliance with the License.
|
|
// You may obtain a copy of the License at
|
|
//
|
|
// http://www.apache.org/licenses/LICENSE-2.0
|
|
//
|
|
// Unless required by applicable law or agreed to in writing, software
|
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
|
// See the License for the specific language governing permissions and
|
|
// limitations under the License.
|
|
|
|
package cmpp
|
|
|
|
import (
|
|
"bytes"
|
|
"crypto/md5"
|
|
"encoding/binary"
|
|
"errors"
|
|
"strconv"
|
|
"time"
|
|
|
|
cmpputils "github.com/bigwhite/gocmpp/utils"
|
|
)
|
|
|
|
// Packet length const for cmpp connect request and response packets.
|
|
const (
|
|
CmppConnReqPktLen uint32 = 4 + 4 + 4 + 6 + 16 + 1 + 4 //39d, 0x27
|
|
Cmpp2ConnRspPktLen uint32 = 4 + 4 + 4 + 1 + 16 + 1 //30d, 0x1e
|
|
Cmpp3ConnRspPktLen uint32 = 4 + 4 + 4 + 4 + 16 + 1 //33d, 0x21
|
|
)
|
|
|
|
// Errors for connect resp status.
|
|
var (
|
|
ErrnoConnInvalidStruct uint8 = 1
|
|
ErrnoConnInvalidSrcAddr uint8 = 2
|
|
ErrnoConnAuthFailed uint8 = 3
|
|
ErrnoConnVerTooHigh uint8 = 4
|
|
ErrnoConnOthers uint8 = 5
|
|
|
|
ConnRspStatusErrMap = map[uint8]error{
|
|
ErrnoConnInvalidStruct: errConnInvalidStruct,
|
|
ErrnoConnInvalidSrcAddr: errConnInvalidSrcAddr,
|
|
ErrnoConnAuthFailed: errConnAuthFailed,
|
|
ErrnoConnVerTooHigh: errConnVerTooHigh,
|
|
ErrnoConnOthers: errConnOthers,
|
|
}
|
|
|
|
errConnInvalidStruct = errors.New("connect response status: invalid protocol structure")
|
|
errConnInvalidSrcAddr = errors.New("connect response status: invalid source address")
|
|
errConnAuthFailed = errors.New("connect response status: auth failed")
|
|
errConnVerTooHigh = errors.New("connect response status: protocol version is too high")
|
|
errConnOthers = errors.New("connect response status: other errors")
|
|
)
|
|
|
|
func now() (string, uint32) {
|
|
s := time.Now().Format("0102150405")
|
|
i, _ := strconv.Atoi(s)
|
|
return s, uint32(i)
|
|
}
|
|
|
|
// CmppConnReqPkt represents a Cmpp2 or Cmpp3 connect request packet.
|
|
//
|
|
// when used in client side(pack), you should initialize it with
|
|
// correct SourceAddr(SrcAddr), Secret and Version.
|
|
//
|
|
// when used in server side(unpack), nothing needed to be initialized.
|
|
// unpack will fill the SourceAddr(SrcAddr), AuthSrc, Version, Timestamp
|
|
// and SeqId
|
|
//
|
|
type CmppConnReqPkt struct {
|
|
SrcAddr string
|
|
AuthSrc string
|
|
Version Type
|
|
Timestamp uint32
|
|
Secret string
|
|
SeqId uint32
|
|
}
|
|
|
|
// Cmpp2ConnRspPkt represents a Cmpp2 connect response packet.
|
|
//
|
|
// when used in server side(pack), you should initialize it with
|
|
// correct Status, AuthSrc, Secret and Version.
|
|
//
|
|
// when used in client side(unpack), nothing needed to be initialized.
|
|
// unpack will fill the Status, AuthImsg, Version and SeqId
|
|
//
|
|
type Cmpp2ConnRspPkt struct {
|
|
Status uint8
|
|
AuthIsmg string
|
|
Version Type
|
|
Secret string
|
|
AuthSrc string
|
|
SeqId uint32
|
|
}
|
|
|
|
// Cmpp3ConnRspPkt represents a Cmpp3 connect response packet.
|
|
//
|
|
// when used in server side(pack), you should initialize it with
|
|
// correct Status, AuthSrc, Secret and Version.
|
|
//
|
|
// when used in client side(unpack), nothing needed to be initialized.
|
|
// unpack will fill the Status, AuthImsg, Version and SeqId
|
|
//
|
|
type Cmpp3ConnRspPkt struct {
|
|
Status uint32
|
|
AuthIsmg string
|
|
Version Type
|
|
Secret string
|
|
AuthSrc string
|
|
SeqId uint32
|
|
}
|
|
|
|
// Pack packs the CmppConnReqPkt to bytes stream for client side.
|
|
// Before calling Pack, you should initialize a CmppConnReqPkt variable
|
|
// with correct SourceAddr(SrcAddr), Secret and Version.
|
|
func (p *CmppConnReqPkt) Pack(seqId uint32) ([]byte, error) {
|
|
var w = newPacketWriter(CmppConnReqPktLen)
|
|
|
|
// Pack header
|
|
w.WriteInt(binary.BigEndian, CmppConnReqPktLen)
|
|
w.WriteInt(binary.BigEndian, CMPP_CONNECT)
|
|
w.WriteInt(binary.BigEndian, seqId)
|
|
p.SeqId = seqId
|
|
|
|
var ts string
|
|
if p.Timestamp == 0 {
|
|
ts, p.Timestamp = now() //default: current time.
|
|
} else {
|
|
ts = cmpputils.TimeStamp2Str(p.Timestamp)
|
|
}
|
|
|
|
// Pack body
|
|
srcAddr := cmpputils.OctetString(p.SrcAddr, 6)
|
|
w.WriteString(srcAddr)
|
|
|
|
md5 := md5.Sum(bytes.Join([][]byte{[]byte(srcAddr),
|
|
make([]byte, 9),
|
|
[]byte(p.Secret),
|
|
[]byte(ts)},
|
|
nil))
|
|
p.AuthSrc = string(md5[:])
|
|
|
|
w.WriteString(p.AuthSrc)
|
|
w.WriteInt(binary.BigEndian, p.Version)
|
|
w.WriteInt(binary.BigEndian, p.Timestamp)
|
|
|
|
return w.Bytes()
|
|
}
|
|
|
|
// Unpack unpack the binary byte stream to a CmppConnReqPkt variable.
|
|
// Usually it is used in server side. After unpack, you will get SeqId, SourceAddr,
|
|
// AuthenticatorSource, Version and Timestamp.
|
|
func (p *CmppConnReqPkt) Unpack(data []byte) error {
|
|
var r = newPacketReader(data)
|
|
|
|
// Sequence Id
|
|
r.ReadInt(binary.BigEndian, &p.SeqId)
|
|
|
|
// Body: Source_Addr
|
|
var sa = make([]byte, 6)
|
|
r.ReadBytes(sa)
|
|
p.SrcAddr = string(sa)
|
|
|
|
// Body: AuthSrc
|
|
var as = make([]byte, 16)
|
|
r.ReadBytes(as)
|
|
p.AuthSrc = string(as)
|
|
|
|
// Body: Version
|
|
r.ReadInt(binary.BigEndian, &p.Version)
|
|
// Body: timestamp
|
|
r.ReadInt(binary.BigEndian, &p.Timestamp)
|
|
|
|
return r.Error()
|
|
}
|
|
|
|
// Pack packs the Cmpp2ConnRspPkt to bytes stream for server side.
|
|
// Before calling Pack, you should initialize a Cmpp2ConnRspPkt variable
|
|
// with correct Status,AuthenticatorSource, Secret and Version.
|
|
func (p *Cmpp2ConnRspPkt) Pack(seqId uint32) ([]byte, error) {
|
|
var w = newPacketWriter(Cmpp2ConnRspPktLen)
|
|
|
|
// pack header
|
|
w.WriteInt(binary.BigEndian, Cmpp2ConnRspPktLen)
|
|
w.WriteInt(binary.BigEndian, CMPP_CONNECT_RESP)
|
|
w.WriteInt(binary.BigEndian, seqId)
|
|
p.SeqId = seqId
|
|
|
|
// pack body
|
|
w.WriteInt(binary.BigEndian, p.Status)
|
|
|
|
md5 := md5.Sum(bytes.Join([][]byte{[]byte{p.Status},
|
|
[]byte(p.AuthSrc),
|
|
[]byte(p.Secret)},
|
|
nil))
|
|
p.AuthIsmg = string(md5[:])
|
|
w.WriteString(p.AuthIsmg)
|
|
|
|
w.WriteInt(binary.BigEndian, p.Version)
|
|
|
|
return w.Bytes()
|
|
}
|
|
|
|
// Unpack unpack the binary byte stream to a Cmpp2ConnRspPkt variable.
|
|
// Usually it is used in client side. After unpack, you will get SeqId, Status,
|
|
// AuthenticatorIsmg, and Version.
|
|
// Parameter data contains seqId in header and the whole packet body.
|
|
func (p *Cmpp2ConnRspPkt) Unpack(data []byte) error {
|
|
var r = newPacketReader(data)
|
|
|
|
// Sequence Id
|
|
r.ReadInt(binary.BigEndian, &p.SeqId)
|
|
|
|
// Body: Status
|
|
r.ReadInt(binary.BigEndian, &p.Status)
|
|
|
|
// Body: AuthenticatorISMG
|
|
var s = make([]byte, 16)
|
|
r.ReadBytes(s)
|
|
p.AuthIsmg = string(s)
|
|
|
|
// Body: Version
|
|
r.ReadInt(binary.BigEndian, &p.Version)
|
|
return r.Error()
|
|
}
|
|
|
|
// Pack packs the Cmpp3ConnRspPkt to bytes stream for server side.
|
|
// Before calling Pack, you should initialize a Cmpp3ConnRspPkt variable
|
|
// with correct Status,AuthenticatorSource, Secret and Version.
|
|
func (p *Cmpp3ConnRspPkt) Pack(seqId uint32) ([]byte, error) {
|
|
var w = newPacketWriter(Cmpp3ConnRspPktLen)
|
|
|
|
// pack header
|
|
w.WriteInt(binary.BigEndian, Cmpp3ConnRspPktLen)
|
|
w.WriteInt(binary.BigEndian, CMPP_CONNECT_RESP)
|
|
w.WriteInt(binary.BigEndian, seqId)
|
|
p.SeqId = seqId
|
|
|
|
// pack body
|
|
w.WriteInt(binary.BigEndian, p.Status)
|
|
|
|
var statusBuf = new(bytes.Buffer)
|
|
err := binary.Write(statusBuf, binary.BigEndian, p.Status)
|
|
if err != nil {
|
|
return nil, err
|
|
}
|
|
|
|
md5 := md5.Sum(bytes.Join([][]byte{statusBuf.Bytes(),
|
|
[]byte(p.AuthSrc),
|
|
[]byte(p.Secret)},
|
|
nil))
|
|
p.AuthIsmg = string(md5[:])
|
|
w.WriteString(p.AuthIsmg)
|
|
|
|
w.WriteInt(binary.BigEndian, p.Version)
|
|
|
|
return w.Bytes()
|
|
}
|
|
|
|
// Unpack unpack the binary byte stream to a Cmpp3ConnRspPkt variable.
|
|
// Usually it is used in client side. After unpack, you will get SeqId, Status,
|
|
// AuthenticatorIsmg, and Version.
|
|
// Parameter data contains seqId in header and the whole packet body.
|
|
func (p *Cmpp3ConnRspPkt) Unpack(data []byte) error {
|
|
var r = newPacketReader(data)
|
|
|
|
// Sequence Id
|
|
r.ReadInt(binary.BigEndian, &p.SeqId)
|
|
|
|
// Body: Status
|
|
r.ReadInt(binary.BigEndian, &p.Status)
|
|
|
|
// Body: AuthenticatorISMG
|
|
var s = make([]byte, 16)
|
|
r.ReadBytes(s)
|
|
p.AuthIsmg = string(s)
|
|
|
|
// Body: Version
|
|
r.ReadInt(binary.BigEndian, &p.Version)
|
|
return r.Error()
|
|
}
|