src/govpn/cmd/govpn-server/tcp.go

   1 /*
   2 GoVPN -- simple secure free software virtual private network daemon
   3 Copyright (C) 2014-2015 Sergey Matveev <stargrave@stargrave.org>
   4
   5 This program is free software: you can redistribute it and/or modify
   6 it under the terms of the GNU General Public License as published by
   7 the Free Software Foundation, either version 3 of the License, or
   8 (at your option) any later version.
   9
  10 This program is distributed in the hope that it will be useful,
  11 but WITHOUT ANY WARRANTY; without even the implied warranty of
  12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13 GNU General Public License for more details.
  14
  15 You should have received a copy of the GNU General Public License
  16 along with this program.  If not, see <http://www.gnu.org/licenses/>.
  17 */
  18
  19 package main
  20
  21 import (
  22         "bytes"
  23         "encoding/binary"
  24         "log"
  25         "net"
  26         "time"
  27
  28         "govpn"
  29 )
  30
  31 func startTCP() {
  32         bind, err := net.ResolveTCPAddr("tcp", *bindAddr)
  33         if err != nil {
  34                 log.Fatalln("Can not resolve bind address:", err)
  35         }
  36         listener, err := net.ListenTCP("tcp", bind)
  37         if err != nil {
  38                 log.Fatalln("Can not listen on TCP:", err)
  39         }
  40         log.Println("Listening on TCP:" + *bindAddr)
  41         go func() {
  42                 for {
  43                         conn, err := listener.AcceptTCP()
  44                         if err != nil {
  45                                 log.Println("Error accepting TCP:", err)
  46                                 continue
  47                         }
  48                         go handleTCP(conn)
  49                 }
  50         }()
  51 }
  52
  53 func handleTCP(conn net.Conn) {
  54         addr := conn.RemoteAddr().String()
  55         buf := make([]byte, govpn.MTU)
  56         var n int
  57         var err error
  58         var prev int
  59         var hs *govpn.Handshake
  60         var ps *PeerState
  61         var peer *govpn.Peer
  62         var tap *govpn.TAP
  63         var conf *govpn.PeerConf
  64         for {
  65                 if prev == govpn.MTU {
  66                         break
  67                 }
  68                 conn.SetReadDeadline(time.Now().Add(time.Duration(govpn.TimeoutDefault) * time.Second))
  69                 n, err = conn.Read(buf[prev:])
  70                 if err != nil {
  71                         // Either EOFed or timeouted
  72                         break
  73                 }
  74                 prev += n
  75                 peerId := idsCache.Find(buf[:prev])
  76                 if peerId == nil {
  77                         continue
  78                 }
  79                 if hs == nil {
  80                         conf = confs[*peerId]
  81                         if conf == nil {
  82                                 log.Println("Can not get peer configuration:", peerId.String())
  83                                 break
  84                         }
  85                         hs = govpn.NewHandshake(addr, conn, conf)
  86                 }
  87                 peer = hs.Server(buf[:prev])
  88                 prev = 0
  89                 if peer == nil {
  90                         continue
  91                 }
  92                 hs.Zero()
  93                 log.Println("Peer handshake finished:", addr, peer.Id.String())
  94                 peersByIdLock.RLock()
  95                 addrPrev, exists := peersById[*peer.Id]
  96                 peersByIdLock.RUnlock()
  97                 if exists {
  98                         peersLock.Lock()
  99                         peers[addrPrev].terminator <- struct{}{}
 100                         tap = peers[addrPrev].tap
 101                         ps = &PeerState{
 102                                 peer:       peer,
 103                                 tap:        tap,
 104                                 terminator: make(chan struct{}),
 105                         }
 106                         go peerReady(*ps)
 107                         peersByIdLock.Lock()
 108                         kpLock.Lock()
 109                         delete(peers, addrPrev)
 110                         delete(knownPeers, addrPrev)
 111                         peers[addr] = ps
 112                         knownPeers[addr] = &peer
 113                         peersById[*peer.Id] = addr
 114                         peersLock.Unlock()
 115                         peersByIdLock.Unlock()
 116                         kpLock.Unlock()
 117                         log.Println("Rehandshake processed:", peer.Id.String())
 118                 } else {
 119                         ifaceName, err := callUp(peer.Id)
 120                         if err != nil {
 121                                 break
 122                         }
 123                         tap, err = govpn.TAPListen(ifaceName)
 124                         if err != nil {
 125                                 log.Println("Unable to create TAP:", err)
 126                                 break
 127                         }
 128                         ps = &PeerState{
 129                                 peer:       peer,
 130                                 tap:        tap,
 131                                 terminator: make(chan struct{}, 1),
 132                         }
 133                         go peerReady(*ps)
 134                         peersLock.Lock()
 135                         peersByIdLock.Lock()
 136                         kpLock.Lock()
 137                         peers[addr] = ps
 138                         peersById[*peer.Id] = addr
 139                         knownPeers[addr] = &peer
 140                         peersLock.Unlock()
 141                         peersByIdLock.Unlock()
 142                         kpLock.Unlock()
 143                         log.Println("Peer created:", peer.Id.String())
 144                 }
 145                 break
 146         }
 147         if hs != nil {
 148                 hs.Zero()
 149         }
 150         if peer == nil {
 151                 return
 152         }
 153
 154         nonceExpectation := make([]byte, govpn.NonceSize)
 155         binary.BigEndian.PutUint64(nonceExpectation, peer.NonceExpect)
 156         peer.NonceCipher.Encrypt(nonceExpectation, nonceExpectation)
 157         prev = 0
 158         var i int
 159         for {
 160                 if prev == govpn.MTU {
 161                         break
 162                 }
 163                 conn.SetReadDeadline(time.Now().Add(conf.Timeout))
 164                 n, err = conn.Read(buf[prev:])
 165                 if err != nil {
 166                         // Either EOFed or timeouted
 167                         break
 168                 }
 169                 prev += n
 170         CheckMore:
 171                 if prev < govpn.MinPktLength {
 172                         continue
 173                 }
 174                 i = bytes.Index(buf[:prev], nonceExpectation)
 175                 if i == -1 {
 176                         continue
 177                 }
 178                 if !peer.PktProcess(buf[:i+govpn.NonceSize], tap, false) {
 179                         log.Println(
 180                                 "Unauthenticated packet, dropping connection",
 181                                 addr, peer.Id.String(),
 182                         )
 183                         break
 184                 }
 185                 binary.BigEndian.PutUint64(nonceExpectation, peer.NonceExpect)
 186                 peer.NonceCipher.Encrypt(nonceExpectation, nonceExpectation)
 187                 copy(buf, buf[i+govpn.NonceSize:prev])
 188                 prev = prev - i - govpn.NonceSize
 189                 goto CheckMore
 190         }
 191         peer.Zero()
 192 }