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 := govpn.IDsCache.Find(buf[:prev])
  76                 if peerId == nil {
  77                         continue
  78                 }
  79                 if hs == nil {
  80                         conf = peerId.Conf()
  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                 peersByIdLock.RLock()
  94                 addrPrev, exists := peersById[*peer.Id]
  95                 peersByIdLock.RUnlock()
  96                 if exists {
  97                         peersLock.RLock()
  98                         tap = peers[addrPrev].tap
  99                         ps = &PeerState{
 100                                 peer:       peer,
 101                                 tap:        tap,
 102                                 terminator: peers[addrPrev].terminator,
 103                         }
 104                         peersLock.RUnlock()
 105                         ps.terminator <- struct{}{}
 106                         peersLock.Lock()
 107                         peersByIdLock.Lock()
 108                         kpLock.Lock()
 109                         delete(peers, addrPrev)
 110                         delete(knownPeers, addrPrev)
 111                         delete(peersById, *peer.Id)
 112                         peers[addr] = ps
 113                         knownPeers[addr] = &peer
 114                         peersById[*peer.Id] = addr
 115                         peersLock.Unlock()
 116                         peersByIdLock.Unlock()
 117                         kpLock.Unlock()
 118                         go peerReady(*ps)
 119                         log.Println("Rehandshake finished:", peer.Id.String())
 120                 } else {
 121                         ifaceName, err := callUp(peer.Id)
 122                         if err != nil {
 123                                 break
 124                         }
 125                         tap, err = govpn.TAPListen(ifaceName)
 126                         if err != nil {
 127                                 log.Println("Unable to create TAP:", err)
 128                                 break
 129                         }
 130                         ps = &PeerState{
 131                                 peer:       peer,
 132                                 tap:        tap,
 133                                 terminator: make(chan struct{}, 1),
 134                         }
 135                         go peerReady(*ps)
 136                         peersLock.Lock()
 137                         peersByIdLock.Lock()
 138                         kpLock.Lock()
 139                         peers[addr] = ps
 140                         peersById[*peer.Id] = addr
 141                         knownPeers[addr] = &peer
 142                         peersLock.Unlock()
 143                         peersByIdLock.Unlock()
 144                         kpLock.Unlock()
 145                         log.Println("New peer:", peer.Id.String())
 146                 }
 147                 break
 148         }
 149         if hs != nil {
 150                 hs.Zero()
 151         }
 152         if peer == nil {
 153                 return
 154         }
 155
 156         nonceExpectation := make([]byte, govpn.NonceSize)
 157         binary.BigEndian.PutUint64(nonceExpectation, peer.NonceExpect)
 158         peer.NonceCipher.Encrypt(nonceExpectation, nonceExpectation)
 159         prev = 0
 160         var i int
 161         for {
 162                 if prev == govpn.MTU {
 163                         break
 164                 }
 165                 conn.SetReadDeadline(time.Now().Add(conf.Timeout))
 166                 n, err = conn.Read(buf[prev:])
 167                 if err != nil {
 168                         // Either EOFed or timeouted
 169                         break
 170                 }
 171                 prev += n
 172         CheckMore:
 173                 i = bytes.Index(buf[:prev], nonceExpectation)
 174                 if i == -1 {
 175                         continue
 176                 }
 177                 if !peer.PktProcess(buf[:i+govpn.NonceSize], tap, false) {
 178                         break
 179                 }
 180                 binary.BigEndian.PutUint64(nonceExpectation, peer.NonceExpect)
 181                 peer.NonceCipher.Encrypt(nonceExpectation, nonceExpectation)
 182                 copy(buf, buf[i+govpn.NonceSize:prev])
 183                 prev = prev - i - govpn.NonceSize
 184                 goto CheckMore
 185         }
 186         peer.Zero()
 187 }