225 lines
3.9 KiB
Go
225 lines
3.9 KiB
Go
package relay
|
|
|
|
import (
|
|
"bytes"
|
|
"encoding/binary"
|
|
"errors"
|
|
"fmt"
|
|
"io"
|
|
"math"
|
|
"net"
|
|
"sync"
|
|
|
|
"github.com/go-gost/core/common/bufpool"
|
|
mdata "github.com/go-gost/core/metadata"
|
|
"github.com/go-gost/relay"
|
|
)
|
|
|
|
type tcpConn struct {
|
|
net.Conn
|
|
wbuf bytes.Buffer
|
|
once sync.Once
|
|
}
|
|
|
|
func (c *tcpConn) Read(b []byte) (n int, err error) {
|
|
c.once.Do(func() {
|
|
err = readResponse(c.Conn)
|
|
})
|
|
|
|
if err != nil {
|
|
return
|
|
}
|
|
return c.Conn.Read(b)
|
|
}
|
|
|
|
func (c *tcpConn) Write(b []byte) (n int, err error) {
|
|
n = len(b) // force byte length consistent
|
|
if c.wbuf.Len() > 0 {
|
|
c.wbuf.Write(b) // append the data to the cached header
|
|
_, err = c.Conn.Write(c.wbuf.Bytes())
|
|
c.wbuf.Reset()
|
|
return
|
|
}
|
|
_, err = c.Conn.Write(b)
|
|
return
|
|
}
|
|
|
|
type udpConn struct {
|
|
net.Conn
|
|
wbuf bytes.Buffer
|
|
once sync.Once
|
|
}
|
|
|
|
func (c *udpConn) Read(b []byte) (n int, err error) {
|
|
c.once.Do(func() {
|
|
err = readResponse(c.Conn)
|
|
})
|
|
if err != nil {
|
|
return
|
|
}
|
|
|
|
var bb [2]byte
|
|
_, err = io.ReadFull(c.Conn, bb[:])
|
|
if err != nil {
|
|
return
|
|
}
|
|
|
|
dlen := int(binary.BigEndian.Uint16(bb[:]))
|
|
if len(b) >= dlen {
|
|
return io.ReadFull(c.Conn, b[:dlen])
|
|
}
|
|
|
|
buf := bufpool.Get(dlen)
|
|
defer bufpool.Put(buf)
|
|
_, err = io.ReadFull(c.Conn, *buf)
|
|
n = copy(b, *buf)
|
|
|
|
return
|
|
}
|
|
|
|
func (c *udpConn) Write(b []byte) (n int, err error) {
|
|
if len(b) > math.MaxUint16 {
|
|
err = errors.New("write: data maximum exceeded")
|
|
return
|
|
}
|
|
|
|
n = len(b)
|
|
if c.wbuf.Len() > 0 {
|
|
var bb [2]byte
|
|
binary.BigEndian.PutUint16(bb[:], uint16(len(b)))
|
|
c.wbuf.Write(bb[:])
|
|
c.wbuf.Write(b) // append the data to the cached header
|
|
_, err = c.wbuf.WriteTo(c.Conn)
|
|
return
|
|
}
|
|
|
|
var bb [2]byte
|
|
binary.BigEndian.PutUint16(bb[:], uint16(len(b)))
|
|
_, err = c.Conn.Write(bb[:])
|
|
if err != nil {
|
|
return
|
|
}
|
|
return c.Conn.Write(b)
|
|
}
|
|
|
|
func readResponse(r io.Reader) (err error) {
|
|
resp := relay.Response{}
|
|
_, err = resp.ReadFrom(r)
|
|
if err != nil {
|
|
return
|
|
}
|
|
|
|
if resp.Version != relay.Version1 {
|
|
err = relay.ErrBadVersion
|
|
return
|
|
}
|
|
|
|
if resp.Status != relay.StatusOK {
|
|
err = fmt.Errorf("status %d", resp.Status)
|
|
return
|
|
}
|
|
return nil
|
|
}
|
|
|
|
type bindConn struct {
|
|
net.Conn
|
|
localAddr net.Addr
|
|
remoteAddr net.Addr
|
|
md mdata.Metadata
|
|
}
|
|
|
|
func (c *bindConn) LocalAddr() net.Addr {
|
|
return c.localAddr
|
|
}
|
|
|
|
func (c *bindConn) RemoteAddr() net.Addr {
|
|
return c.remoteAddr
|
|
}
|
|
|
|
// Metadata implements metadata.Metadatable interface.
|
|
func (c *bindConn) Metadata() mdata.Metadata {
|
|
return c.md
|
|
}
|
|
|
|
type bindUDPConn struct {
|
|
net.Conn
|
|
localAddr net.Addr
|
|
remoteAddr net.Addr
|
|
md mdata.Metadata
|
|
}
|
|
|
|
func (c *bindUDPConn) Read(b []byte) (n int, err error) {
|
|
// 2-byte data length header
|
|
var bh [2]byte
|
|
_, err = io.ReadFull(c.Conn, bh[:])
|
|
if err != nil {
|
|
return
|
|
}
|
|
|
|
dlen := int(binary.BigEndian.Uint16(bh[:]))
|
|
if len(b) >= dlen {
|
|
n, err = io.ReadFull(c.Conn, b[:dlen])
|
|
return
|
|
}
|
|
|
|
buf := bufpool.Get(dlen)
|
|
defer bufpool.Put(buf)
|
|
|
|
_, err = io.ReadFull(c.Conn, *buf)
|
|
n = copy(b, *buf)
|
|
|
|
return
|
|
}
|
|
|
|
func (c *bindUDPConn) Write(b []byte) (n int, err error) {
|
|
if len(b) > math.MaxUint16 {
|
|
err = errors.New("write: data maximum exceeded")
|
|
return
|
|
}
|
|
|
|
// 2-byte data length header
|
|
var bh [2]byte
|
|
binary.BigEndian.PutUint16(bh[:], uint16(len(b)))
|
|
_, err = c.Conn.Write(bh[:])
|
|
if err != nil {
|
|
return
|
|
}
|
|
return c.Conn.Write(b)
|
|
}
|
|
|
|
func (c *bindUDPConn) ReadFrom(b []byte) (n int, addr net.Addr, err error) {
|
|
addr = c.remoteAddr
|
|
n, err = c.Read(b)
|
|
return
|
|
}
|
|
|
|
func (c *bindUDPConn) WriteTo(b []byte, addr net.Addr) (n int, err error) {
|
|
return c.Write(b)
|
|
}
|
|
|
|
func (c *bindUDPConn) LocalAddr() net.Addr {
|
|
return c.localAddr
|
|
}
|
|
|
|
func (c *bindUDPConn) RemoteAddr() net.Addr {
|
|
return c.remoteAddr
|
|
}
|
|
|
|
// Metadata implements metadata.Metadatable interface.
|
|
func (c *bindUDPConn) Metadata() mdata.Metadata {
|
|
return c.md
|
|
}
|
|
|
|
type bindAddr struct {
|
|
network string
|
|
addr string
|
|
}
|
|
|
|
func (p *bindAddr) Network() string {
|
|
return p.network
|
|
}
|
|
|
|
func (p *bindAddr) String() string {
|
|
return p.addr
|
|
}
|