package main import ( "bytes" "fmt" "net" "time" "github.com/nonoo/kappanhang/log" ) type portCommon struct { conn *net.UDPConn localSID uint32 remoteSID uint32 sendSeq uint16 } func (p *portCommon) send(d []byte) { _, err := p.conn.Write(d) if err != nil { log.Fatal(err) } } func (p *portCommon) read() ([]byte, error) { err := p.conn.SetReadDeadline(time.Now().Add(time.Second)) if err != nil { log.Fatal(err) } b := make([]byte, 1500) n, _, err := p.conn.ReadFromUDP(b) if err != nil { log.Fatal(err) } return b[:n], err } func (p *portCommon) expect(packetLength int, b []byte) []byte { var r []byte expectStart := time.Now() for { r, _ = p.read() if len(r) == packetLength && bytes.Equal(r[:len(b)], b) { break } if time.Since(expectStart) > time.Second { log.Fatal("expect timeout") } } return r } func (p *portCommon) open(portNumber int) { hostPort := fmt.Sprint(connectAddress, ":", portNumber) log.Print("connecting to ", hostPort) raddr, err := net.ResolveUDPAddr("udp", hostPort) if err != nil { log.Fatal(err) } laddr := net.UDPAddr{ Port: portNumber, } p.conn, err = net.DialUDP("udp", &laddr, raddr) if err != nil { log.Fatal(err) } p.localSID = uint32(time.Now().Unix()) log.Debugf("using session id %.8x", p.localSID) } func (p *portCommon) sendPkt3() { p.send([]byte{0x10, 0x00, 0x00, 0x00, 0x03, 0x00, byte(p.sendSeq), byte(p.sendSeq >> 8), byte(p.localSID >> 24), byte(p.localSID >> 16), byte(p.localSID >> 8), byte(p.localSID), byte(p.remoteSID >> 24), byte(p.remoteSID >> 16), byte(p.remoteSID >> 8), byte(p.remoteSID)}) } func (p *portCommon) sendPkt6() { p.send([]byte{0x10, 0x00, 0x00, 0x00, 0x06, 0x00, 0x01, 0x00, byte(p.localSID >> 24), byte(p.localSID >> 16), byte(p.localSID >> 8), byte(p.localSID), byte(p.remoteSID >> 24), byte(p.remoteSID >> 16), byte(p.remoteSID >> 8), byte(p.remoteSID)}) }