src/yggdrasil/tcpip.go

   1 //go:build !noyggdrasil
   2 // +build !noyggdrasil
   3
   4 /*
   5 NNCP -- Node to Node copy, utilities for store-and-forward data exchange
   6 Copyright (C) 2016-2022 Sergey Matveev <stargrave@stargrave.org>
   7
   8 This program is free software: you can redistribute it and/or modify
   9 it under the terms of the GNU General Public License as published by
  10 the Free Software Foundation, version 3 of the License.
  11
  12 This program is distributed in the hope that it will be useful,
  13 but WITHOUT ANY WARRANTY; without even the implied warranty of
  14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15 GNU General Public License for more details.
  16
  17 You should have received a copy of the GNU General Public License
  18 along with this program.  If not, see <http://www.gnu.org/licenses/>.
  19
  20 Code below is heavily based on Wireguard's MIT licenced
  21 golang.zx2c4.com/wireguard/tun/netstack.
  22 */
  23
  24 package yggdrasil
  25
  26 import (
  27         "fmt"
  28         "log"
  29         "net"
  30
  31         iwt "github.com/Arceliar/ironwood/types"
  32         yaddr "github.com/yggdrasil-network/yggdrasil-go/src/address"
  33         "golang.org/x/crypto/ed25519"
  34         "gvisor.dev/gvisor/pkg/tcpip"
  35         "gvisor.dev/gvisor/pkg/tcpip/adapters/gonet"
  36         "gvisor.dev/gvisor/pkg/tcpip/buffer"
  37         "gvisor.dev/gvisor/pkg/tcpip/header"
  38         "gvisor.dev/gvisor/pkg/tcpip/network/ipv6"
  39         "gvisor.dev/gvisor/pkg/tcpip/stack"
  40         "gvisor.dev/gvisor/pkg/tcpip/transport/tcp"
  41 )
  42
  43 const IPv6HdrSize = 40
  44
  45 type TCPIPEndpoint struct {
  46         mtu      uint32
  47         s        *stack.Stack
  48         pc       net.PacketConn
  49         d        stack.NetworkDispatcher
  50         readBuf  []byte
  51         writeBuf []byte
  52         ip       yaddr.Address
  53         ipToAddr map[yaddr.Address]net.Addr
  54         pubToIP  map[[ed25519.PublicKeySize]byte]yaddr.Address
  55 }
  56
  57 func (e *TCPIPEndpoint) Attach(dispatcher stack.NetworkDispatcher) { e.d = dispatcher }
  58
  59 func (e *TCPIPEndpoint) IsAttached() bool { return e.d != nil }
  60
  61 func (e *TCPIPEndpoint) MTU() uint32 { return e.mtu }
  62
  63 func (*TCPIPEndpoint) Capabilities() stack.LinkEndpointCapabilities { return stack.CapabilityNone }
  64
  65 func (*TCPIPEndpoint) MaxHeaderLength() uint16 { return 0 }
  66
  67 func (*TCPIPEndpoint) LinkAddress() tcpip.LinkAddress { return "" }
  68
  69 func (*TCPIPEndpoint) Wait() {}
  70
  71 func (e *TCPIPEndpoint) WritePacket(
  72         _ stack.RouteInfo,
  73         _ *stack.GSO,
  74         _ tcpip.NetworkProtocolNumber,
  75         pkt *stack.PacketBuffer,
  76 ) tcpip.Error {
  77         vv := buffer.NewVectorisedView(pkt.Size(), pkt.Views())
  78         n, err := vv.Read(e.writeBuf)
  79         if err != nil {
  80                 log.Println(err)
  81                 return &tcpip.ErrAborted{}
  82         }
  83         copy(e.ip[:], e.writeBuf[IPv6HdrSize-len(e.ip):IPv6HdrSize])
  84         addr, ok := e.ipToAddr[e.ip]
  85         if !ok {
  86                 log.Println("no address found:", e.ip)
  87                 return nil
  88         }
  89         _, err = e.pc.WriteTo(e.writeBuf[:n], addr)
  90         if err != nil {
  91                 log.Println(err)
  92                 return &tcpip.ErrAborted{}
  93         }
  94         return nil
  95 }
  96
  97 func (e *TCPIPEndpoint) WritePackets(
  98         stack.RouteInfo,
  99         *stack.GSO,
 100         stack.PacketBufferList,
 101         tcpip.NetworkProtocolNumber,
 102 ) (int, tcpip.Error) {
 103         panic("not implemented")
 104 }
 105
 106 func (*TCPIPEndpoint) ARPHardwareType() header.ARPHardwareType { return header.ARPHardwareNone }
 107
 108 func (e *TCPIPEndpoint) AddHeader(
 109         tcpip.LinkAddress,
 110         tcpip.LinkAddress,
 111         tcpip.NetworkProtocolNumber,
 112         *stack.PacketBuffer,
 113 ) {
 114 }
 115
 116 func convertToFullAddr(ip net.IP, port int) (tcpip.FullAddress, tcpip.NetworkProtocolNumber) {
 117         return tcpip.FullAddress{
 118                 NIC:  1,
 119                 Addr: tcpip.Address(ip),
 120                 Port: uint16(port),
 121         }, ipv6.ProtocolNumber
 122 }
 123
 124 func (e *TCPIPEndpoint) DialTCP(addr *net.TCPAddr) (*gonet.TCPConn, error) {
 125         if addr == nil {
 126                 panic("not implemented")
 127         }
 128         fa, pn := convertToFullAddr(addr.IP, addr.Port)
 129         return gonet.DialTCP(e.s, fa, pn)
 130 }
 131
 132 func (e *TCPIPEndpoint) ListenTCP(addr *net.TCPAddr) (*gonet.TCPListener, error) {
 133         if addr == nil {
 134                 panic("not implemented")
 135         }
 136         fa, pn := convertToFullAddr(addr.IP, addr.Port)
 137         return gonet.ListenTCP(e.s, fa, pn)
 138 }
 139
 140 func (e *TCPIPEndpoint) Close() error {
 141         e.s.RemoveNIC(1)
 142         return nil
 143 }
 144
 145 func NewTCPIPEndpoint(
 146         pc net.PacketConn,
 147         ipOur net.IP,
 148         mtu uint32,
 149 ) (*TCPIPEndpoint, error) {
 150         s := stack.New(stack.Options{
 151                 NetworkProtocols:   []stack.NetworkProtocolFactory{ipv6.NewProtocol},
 152                 TransportProtocols: []stack.TransportProtocolFactory{tcp.NewProtocol},
 153                 HandleLocal:        true,
 154         })
 155         e := TCPIPEndpoint{
 156                 mtu:      mtu,
 157                 s:        s,
 158                 pc:       pc,
 159                 readBuf:  make([]byte, 1<<16),
 160                 writeBuf: make([]byte, 1<<16),
 161                 ipToAddr: make(map[yaddr.Address]net.Addr),
 162                 pubToIP:  make(map[[ed25519.PublicKeySize]byte]yaddr.Address),
 163         }
 164         if err := s.CreateNIC(1, &e); err != nil {
 165                 return nil, fmt.Errorf("%+v", err)
 166         }
 167         if err := s.AddAddress(1, ipv6.ProtocolNumber, tcpip.Address(ipOur)); err != nil {
 168                 return nil, fmt.Errorf("%+v", err)
 169         }
 170         s.AddRoute(tcpip.Route{Destination: header.IPv6EmptySubnet, NIC: 1})
 171         go func() {
 172                 var n int
 173                 var from net.Addr
 174                 var err error
 175                 var pub [ed25519.PublicKeySize]byte
 176                 for {
 177                         n, from, err = pc.ReadFrom(e.readBuf)
 178                         if err != nil {
 179                                 log.Println(err)
 180                                 break
 181                         }
 182                         copy(pub[:], from.(iwt.Addr))
 183                         ip, ok := e.pubToIP[pub]
 184                         if !ok {
 185                                 copy(ip[:], yaddr.AddrForKey(ed25519.PublicKey(pub[:]))[:])
 186                                 e.pubToIP[pub] = ip
 187                                 e.ipToAddr[ip] = from
 188                         }
 189                         pkb := stack.NewPacketBuffer(stack.PacketBufferOptions{
 190                                 Data: buffer.NewVectorisedView(n, []buffer.View{
 191                                         buffer.NewViewFromBytes(e.readBuf[:n]),
 192                                 }),
 193                         })
 194                         e.d.DeliverNetworkPacket("", "", ipv6.ProtocolNumber, pkb)
 195                 }
 196         }()
 197         return &e, nil
 198 }