ginuerzh
300 lines
6.3 KiB
Go
300 lines
6.3 KiB
Go
package router
|
|
|
|
import (
|
|
"bytes"
|
|
"context"
|
|
"encoding/binary"
|
|
"errors"
|
|
"fmt"
|
|
"io"
|
|
"math"
|
|
"net"
|
|
"sync"
|
|
|
|
"github.com/go-gost/core/common/bufpool"
|
|
"github.com/go-gost/core/limiter"
|
|
"github.com/go-gost/core/logger"
|
|
"github.com/go-gost/core/observer/stats"
|
|
"github.com/go-gost/core/router"
|
|
"github.com/go-gost/core/sd"
|
|
"github.com/go-gost/relay"
|
|
xip "github.com/go-gost/x/internal/net/ip"
|
|
traffic_wrapper "github.com/go-gost/x/limiter/traffic/wrapper"
|
|
stats_wrapper "github.com/go-gost/x/observer/stats/wrapper"
|
|
"github.com/go-gost/x/registry"
|
|
"github.com/google/uuid"
|
|
"github.com/songgao/water/waterutil"
|
|
"golang.org/x/net/ipv4"
|
|
"golang.org/x/net/ipv6"
|
|
)
|
|
|
|
func (h *routerHandler) handleAssociate(ctx context.Context, conn net.Conn, network, host string, routerID relay.TunnelID, log logger.Logger) (err error) {
|
|
log = log.WithFields(map[string]any{
|
|
"dst": fmt.Sprintf("%s/%s", host, network),
|
|
"cmd": "associate",
|
|
"router": routerID.String(),
|
|
"host": host,
|
|
})
|
|
|
|
resp := relay.Response{
|
|
Version: relay.Version1,
|
|
Status: relay.StatusOK,
|
|
}
|
|
|
|
if ingress := h.md.ingress; ingress != nil && host != "" {
|
|
var rid relay.TunnelID
|
|
if rule := ingress.GetRule(ctx, host); rule != nil {
|
|
rid = parseRouterID(rule.Endpoint)
|
|
}
|
|
|
|
if rid.IsZero() || !rid.Equal(routerID) {
|
|
resp.Status = relay.StatusHostUnreachable
|
|
resp.WriteTo(conn)
|
|
err := fmt.Errorf("no route to host %s", host)
|
|
log.Error(err)
|
|
return err
|
|
}
|
|
}
|
|
|
|
uuid, err := uuid.NewRandom()
|
|
if err != nil {
|
|
resp.Status = relay.StatusInternalServerError
|
|
resp.WriteTo(conn)
|
|
return
|
|
}
|
|
connectorID := relay.NewConnectorID(uuid[:])
|
|
|
|
resp.Features = append(resp.Features,
|
|
&relay.TunnelFeature{
|
|
ID: connectorID,
|
|
},
|
|
)
|
|
resp.WriteTo(conn)
|
|
|
|
conn = &packetConn{conn}
|
|
|
|
clientID := fmt.Sprintf("%s@%s", host, routerID)
|
|
var stats stats.Stats
|
|
if h.stats != nil {
|
|
stats = h.stats.Stats(clientID)
|
|
}
|
|
conn = stats_wrapper.WrapConn(conn, stats)
|
|
conn = traffic_wrapper.WrapConn(
|
|
conn,
|
|
h.limiter,
|
|
clientID,
|
|
limiter.ScopeOption(limiter.ScopeClient),
|
|
limiter.ServiceOption(h.options.Service),
|
|
limiter.ClientOption(clientID),
|
|
limiter.NetworkOption(network),
|
|
limiter.SrcOption(conn.RemoteAddr().String()),
|
|
)
|
|
|
|
h.pool.Add(routerID, NewConnector(routerID, connectorID, host, LockWriter(conn), &ConnectorOptions{}))
|
|
defer h.pool.Del(routerID, host, connectorID)
|
|
|
|
if h.md.sd != nil {
|
|
err := h.md.sd.Register(ctx, &sd.Service{
|
|
ID: connectorID.String(),
|
|
Name: clientID,
|
|
Node: h.id,
|
|
Network: "udp",
|
|
Address: h.md.entryPoint,
|
|
})
|
|
if err != nil {
|
|
h.log.Error(err)
|
|
}
|
|
|
|
defer h.md.sd.Deregister(ctx, &sd.Service{
|
|
ID: connectorID.String(),
|
|
Name: clientID,
|
|
Node: h.id,
|
|
})
|
|
}
|
|
|
|
log.Debugf("%s/%s: router=%s, connector=%s, weight=%d established", host, network, routerID, connectorID, connectorID.Weight())
|
|
|
|
for {
|
|
b := bufpool.Get(h.md.bufferSize)
|
|
|
|
n, err := conn.Read(b)
|
|
if err != nil {
|
|
if err == io.EOF {
|
|
return nil
|
|
}
|
|
return err
|
|
}
|
|
|
|
h.handlePacket(ctx, b[:n], routerID, log)
|
|
}
|
|
}
|
|
|
|
func (h *routerHandler) handlePacket(ctx context.Context, data []byte, routerID relay.TunnelID, log logger.Logger) error {
|
|
defer bufpool.Put(data)
|
|
|
|
var dstIP net.IP
|
|
if waterutil.IsIPv4(data) {
|
|
header, err := ipv4.ParseHeader(data)
|
|
if err != nil {
|
|
return err
|
|
}
|
|
|
|
dstIP = header.Dst
|
|
|
|
if log.IsLevelEnabled(logger.TraceLevel) {
|
|
log.Tracef("%s >> %s %-4s %d/%-4d %-4x %d",
|
|
header.Src, header.Dst, xip.Protocol(waterutil.IPv4Protocol(data)),
|
|
header.Len, header.TotalLen, header.ID, header.Flags)
|
|
}
|
|
} else if waterutil.IsIPv6(data) {
|
|
header, err := ipv6.ParseHeader(data)
|
|
if err != nil {
|
|
return err
|
|
}
|
|
|
|
dstIP = header.Dst
|
|
|
|
if log.IsLevelEnabled(logger.TraceLevel) {
|
|
log.Tracef("%s >> %s %s %d %d",
|
|
header.Src, header.Dst,
|
|
xip.Protocol(waterutil.IPProtocol(header.NextHeader)),
|
|
header.PayloadLen, header.TrafficClass)
|
|
}
|
|
} else {
|
|
return fmt.Errorf("unknown packet, discarded(%d)", len(data))
|
|
}
|
|
|
|
rid := routerID.String()
|
|
|
|
var route *router.Route
|
|
if r := registry.RouterRegistry().Get(rid); r != nil {
|
|
route = r.GetRoute(ctx, dstIP.String(), router.IDOption(rid))
|
|
}
|
|
if route == nil && h.md.router != nil {
|
|
route = h.md.router.GetRoute(ctx, dstIP.String(), router.IDOption(rid))
|
|
}
|
|
if route == nil || route.Gateway == "" {
|
|
// no route to host, discard
|
|
return fmt.Errorf("route to host %s", dstIP)
|
|
}
|
|
|
|
if log.IsLevelEnabled(logger.TraceLevel) {
|
|
log.Tracef("route for %s: %s -> %s", dstIP, route.Dst, route.Gateway)
|
|
}
|
|
|
|
if c := h.pool.Get(routerID, route.Gateway); c != nil {
|
|
if w := c.Writer(); w != nil {
|
|
w.Write(data)
|
|
}
|
|
return nil
|
|
}
|
|
|
|
if h.md.sd == nil {
|
|
return nil
|
|
}
|
|
|
|
clientID := fmt.Sprintf("%s@%s", route.Gateway, routerID)
|
|
ss, _ := h.md.sd.Get(ctx, clientID)
|
|
|
|
var service *sd.Service
|
|
for _, s := range ss {
|
|
if s.Node != h.id {
|
|
service = s
|
|
break
|
|
}
|
|
}
|
|
if service == nil {
|
|
return nil
|
|
}
|
|
|
|
raddr, _ := net.ResolveUDPAddr("udp", service.Address)
|
|
if raddr == nil {
|
|
return nil
|
|
}
|
|
|
|
req := &relay.Request{
|
|
Version: relay.Version1,
|
|
Cmd: relay.CmdAssociate,
|
|
Features: []relay.Feature{
|
|
&relay.TunnelFeature{
|
|
ID: routerID,
|
|
},
|
|
&relay.AddrFeature{
|
|
AType: relay.AddrDomain,
|
|
Host: route.Gateway,
|
|
},
|
|
},
|
|
}
|
|
|
|
buf := bytes.Buffer{}
|
|
req.WriteTo(&buf)
|
|
buf.Write(data)
|
|
|
|
h.epConn.WriteTo(buf.Bytes(), raddr)
|
|
|
|
return nil
|
|
}
|
|
|
|
type packetConn struct {
|
|
net.Conn
|
|
}
|
|
|
|
func (c *packetConn) Read(b []byte) (n int, err error) {
|
|
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)
|
|
|
|
n, err = io.ReadFull(c.Conn, buf)
|
|
copy(b, buf[:n])
|
|
|
|
return
|
|
}
|
|
|
|
func (c *packetConn) Write(b []byte) (n int, err error) {
|
|
if len(b) > math.MaxUint16 {
|
|
err = errors.New("write: data maximum exceeded")
|
|
return
|
|
}
|
|
|
|
buf := bufpool.Get(len(b) + 2)
|
|
defer bufpool.Put(buf)
|
|
|
|
binary.BigEndian.PutUint16(buf[:2], uint16(len(b)))
|
|
n = copy(buf[2:], b)
|
|
|
|
return c.Conn.Write(buf)
|
|
}
|
|
|
|
type lockWriter struct {
|
|
w io.Writer
|
|
mu sync.Mutex
|
|
}
|
|
|
|
func LockWriter(w io.Writer) io.Writer {
|
|
return &lockWriter{w: w}
|
|
}
|
|
|
|
func (w *lockWriter) Write(p []byte) (int, error) {
|
|
w.mu.Lock()
|
|
defer w.mu.Unlock()
|
|
|
|
return w.w.Write(p)
|
|
}
|
|
|
|
func (w *lockWriter) Close() error {
|
|
if closer, ok := w.w.(io.Closer); ok {
|
|
return closer.Close()
|
|
}
|
|
return nil
|
|
}
|