154 lines
3.2 KiB
Go
154 lines
3.2 KiB
Go
package tun
|
|
|
|
import (
|
|
"context"
|
|
"errors"
|
|
"fmt"
|
|
"net"
|
|
"sync"
|
|
"time"
|
|
|
|
"github.com/go-gost/core/chain"
|
|
"github.com/go-gost/core/handler"
|
|
"github.com/go-gost/core/hop"
|
|
md "github.com/go-gost/core/metadata"
|
|
"github.com/go-gost/core/router"
|
|
tun_util "github.com/go-gost/x/internal/util/tun"
|
|
"github.com/go-gost/x/registry"
|
|
"github.com/songgao/water/waterutil"
|
|
)
|
|
|
|
var (
|
|
ErrTun = errors.New("tun device error")
|
|
ErrInvalidNet = errors.New("invalid net IP")
|
|
)
|
|
|
|
func init() {
|
|
registry.HandlerRegistry().Register("tun", NewHandler)
|
|
}
|
|
|
|
type tunHandler struct {
|
|
hop hop.Hop
|
|
routes sync.Map
|
|
router *chain.Router
|
|
md metadata
|
|
options handler.Options
|
|
}
|
|
|
|
func NewHandler(opts ...handler.Option) handler.Handler {
|
|
options := handler.Options{}
|
|
for _, opt := range opts {
|
|
opt(&options)
|
|
}
|
|
|
|
return &tunHandler{
|
|
options: options,
|
|
}
|
|
}
|
|
|
|
func (h *tunHandler) Init(md md.Metadata) (err error) {
|
|
if err = h.parseMetadata(md); err != nil {
|
|
return
|
|
}
|
|
|
|
h.router = h.options.Router
|
|
if h.router == nil {
|
|
h.router = chain.NewRouter(chain.LoggerRouterOption(h.options.Logger))
|
|
}
|
|
|
|
return
|
|
}
|
|
|
|
// Forward implements handler.Forwarder.
|
|
func (h *tunHandler) Forward(hop hop.Hop) {
|
|
h.hop = hop
|
|
}
|
|
|
|
func (h *tunHandler) Handle(ctx context.Context, conn net.Conn, opts ...handler.HandleOption) error {
|
|
defer conn.Close()
|
|
|
|
log := h.options.Logger
|
|
|
|
v, _ := conn.(md.Metadatable)
|
|
if v == nil {
|
|
err := errors.New("tun: wrong connection type")
|
|
log.Error(err)
|
|
return err
|
|
}
|
|
config := v.Metadata().Get("config").(*tun_util.Config)
|
|
|
|
start := time.Now()
|
|
log = log.WithFields(map[string]any{
|
|
"remote": conn.RemoteAddr().String(),
|
|
"local": conn.LocalAddr().String(),
|
|
})
|
|
|
|
log.Infof("%s <> %s", conn.RemoteAddr(), conn.LocalAddr())
|
|
defer func() {
|
|
log.WithFields(map[string]any{
|
|
"duration": time.Since(start),
|
|
}).Infof("%s >< %s", conn.RemoteAddr(), conn.LocalAddr())
|
|
}()
|
|
|
|
var target *chain.Node
|
|
if h.hop != nil {
|
|
target = h.hop.Select(ctx)
|
|
}
|
|
if target != nil {
|
|
log = log.WithFields(map[string]any{
|
|
"dst": fmt.Sprintf("%s/%s", target.Addr, "udp"),
|
|
})
|
|
log.Debugf("%s >> %s", conn.RemoteAddr(), target.Addr)
|
|
|
|
if err := h.handleClient(ctx, conn, target.Addr, config, log); err != nil {
|
|
log.Error(err)
|
|
}
|
|
return nil
|
|
}
|
|
|
|
return h.handleServer(ctx, conn, config, log)
|
|
}
|
|
|
|
func (h *tunHandler) findRouteFor(ctx context.Context, dst net.IP, router router.Router) net.Addr {
|
|
if v, ok := h.routes.Load(ipToTunRouteKey(dst)); ok {
|
|
return v.(net.Addr)
|
|
}
|
|
|
|
if router == nil {
|
|
return nil
|
|
}
|
|
|
|
if route := router.GetRoute(ctx, dst); route != nil && route.Gateway != nil {
|
|
if v, ok := h.routes.Load(ipToTunRouteKey(route.Gateway)); ok {
|
|
return v.(net.Addr)
|
|
}
|
|
}
|
|
return nil
|
|
}
|
|
|
|
var mIPProts = map[waterutil.IPProtocol]string{
|
|
waterutil.HOPOPT: "HOPOPT",
|
|
waterutil.ICMP: "ICMP",
|
|
waterutil.IGMP: "IGMP",
|
|
waterutil.GGP: "GGP",
|
|
waterutil.TCP: "TCP",
|
|
waterutil.UDP: "UDP",
|
|
waterutil.IPv6_Route: "IPv6-Route",
|
|
waterutil.IPv6_Frag: "IPv6-Frag",
|
|
waterutil.IPv6_ICMP: "IPv6-ICMP",
|
|
}
|
|
|
|
func ipProtocol(p waterutil.IPProtocol) string {
|
|
if v, ok := mIPProts[p]; ok {
|
|
return v
|
|
}
|
|
return fmt.Sprintf("unknown(%d)", p)
|
|
}
|
|
|
|
type tunRouteKey [16]byte
|
|
|
|
func ipToTunRouteKey(ip net.IP) (key tunRouteKey) {
|
|
copy(key[:], ip.To16())
|
|
return
|
|
}
|