gost_software/conn.go

package main

import (
	"bufio"
	"bytes"
	"crypto/tls"
	"encoding/base64"
	"errors"
	"github.com/ginuerzh/gosocks5"
	"github.com/golang/glog"
	"io"
	"net"
	"net/http"
	"net/http/httputil"
	"net/url"
	"strconv"
	"strings"
)

const (
	ConnHttp        = "http"
	ConnHttpConnect = "http-connect"
	ConnSocks5      = "socks5"
)

func listenAndServe(arg Args) error {
	var ln net.Listener
	var err error

	if glog.V(3) {
		b := bytes.Buffer{}
		b.WriteString("listen on %s, use %s tunnel and %s protocol for data transport. ")
		if arg.EncMeth == "tls" {
			b.WriteString("for socks5, tls encrypt method is supported.")
		} else {
			b.WriteString("for socks5, tls encrypt method is NOT supported.")
		}
		protocol := arg.Protocol
		if protocol == "" {
			protocol = "http/socks5"
		}
		glog.Infof(b.String(), arg.Addr, arg.Transport, protocol)

	}

	switch arg.Transport {
	case "ws": // websocket connection
		err = NewWs(arg).ListenAndServe()
		if err != nil {
			if glog.V(LFATAL) {
				glog.Errorln(err)
			}
		}
		return err
	case "tls": // tls connection
		ln, err = tls.Listen("tcp", arg.Addr,
			&tls.Config{Certificates: []tls.Certificate{arg.Cert}})
	case "tcp":
		fallthrough
	default:
		ln, err = net.Listen("tcp", arg.Addr)
	}

	if err != nil {
		if glog.V(LFATAL) {
			glog.Errorln(err)
		}
		return err
	}

	defer ln.Close()

	for {
		conn, err := ln.Accept()
		if err != nil {
			if glog.V(LWARNING) {
				glog.Warningln(err)
			}
			continue
		}
		if glog.V(LINFO) {
			glog.Infoln("accept", conn.RemoteAddr())
		}
		go handleConn(conn, arg)
	}

	return nil
}

func handleConn(conn net.Conn, arg Args) {
	defer conn.Close()

	selector := &serverSelector{
		methods: []uint8{
			gosocks5.MethodNoAuth,
			gosocks5.MethodUserPass,
		},
		arg: arg,
	}

	if arg.EncMeth == "tls" {
		selector.methods = append(selector.methods, MethodTLS, MethodTLSAuth)
	}

	switch arg.Protocol {
	case "ss": // shadowsocks
		return
	case "http":
		req, err := http.ReadRequest(bufio.NewReader(conn))
		if err != nil {
			if glog.V(LWARNING) {
				glog.Warningln(err)
			}
			return
		}
		handleHttpRequest(req, conn, arg)
		return
	case "socks", "socks5":
		conn = gosocks5.ServerConn(conn, selector)
		req, err := gosocks5.ReadRequest(conn)
		if err != nil {
			if glog.V(LWARNING) {
				glog.Warningln("socks5:", err)
			}
			return
		}
		handleSocks5Request(req, conn, arg)
		return
	}

	// http + socks5

	b := make([]byte, 16*1024)

	n, err := io.ReadAtLeast(conn, b, 2)
	if err != nil {
		if glog.V(LWARNING) {
			glog.Warningln(err)
		}
		return
	}

	if b[0] == gosocks5.Ver5 {
		mn := int(b[1]) // methods count
		length := 2 + mn
		if n < length {
			if _, err := io.ReadFull(conn, b[n:length]); err != nil {
				if glog.V(LWARNING) {
					glog.Warningln("socks5:", err)
				}
				return
			}
		}
		methods := b[2 : 2+mn]
		method := selector.Select(methods...)
		if _, err := conn.Write([]byte{gosocks5.Ver5, method}); err != nil {
			if glog.V(LWARNING) {
				glog.Warningln("socks5:", err)
			}
			return
		}
		c, err := selector.OnSelected(method, conn)
		if err != nil {
			if glog.V(LWARNING) {
				glog.Warningln("socks5:", err)
			}
			return
		}
		conn = c

		req, err := gosocks5.ReadRequest(conn)
		if err != nil {
			if glog.V(LWARNING) {
				glog.Warningln("socks5:", err)
			}
			return
		}
		handleSocks5Request(req, conn, arg)
		return
	}

	req, err := http.ReadRequest(bufio.NewReader(newReqReader(b[:n], conn)))
	if err != nil {
		if glog.V(LWARNING) {
			glog.Warningln(err)
		}
		return
	}
	handleHttpRequest(req, conn, arg)
}

type reqReader struct {
	b []byte
	r io.Reader
}

func newReqReader(b []byte, r io.Reader) *reqReader {
	return &reqReader{
		b: b,
		r: r,
	}
}

func (r *reqReader) Read(p []byte) (n int, err error) {
	if len(r.b) == 0 {
		return r.r.Read(p)
	}
	n = copy(p, r.b)
	r.b = r.b[n:]

	return
}

func connect(connType, addr string) (conn net.Conn, err error) {
	if !strings.Contains(addr, ":") {
		addr += ":80"
	}

	if len(proxyArgs) > 0 && len(forwardArgs) > 0 {
		return connectProxyForward(connType, addr, proxyArgs[0], forwardArgs[0])
	}

	if len(forwardArgs) > 0 {
		// TODO: multi-foward
		forward := forwardArgs[0]
		return connectForward(connType, addr, forward)
	}

	if len(proxyArgs) > 0 {
		proxy := proxyArgs[0]
		return connectForward(connType, addr, proxy)
	}

	return net.Dial("tcp", addr)
}

func connectProxyForward(connType, addr string, proxy, forward Args) (conn net.Conn, err error) {
	return nil, errors.New("Not implemented")
}

func connectForward(connType, addr string, forward Args) (conn net.Conn, err error) {
	if glog.V(LINFO) {
		glog.Infoln(forward.Protocol, "forward:", forward.Addr)
	}
	conn, err = net.Dial("tcp", forward.Addr)
	if err != nil {
		return
	}

	switch forward.Transport {
	case "ws": // websocket connection
		c, err := wsClient(conn, forward.Addr)
		if err != nil {
			conn.Close()
			return nil, err
		}
		conn = c
	case "tls": // tls connection
		conn = tls.Client(conn, &tls.Config{InsecureSkipVerify: true})
	case "tcp":
		fallthrough
	default:
	}

	switch forward.Protocol {
	case "ss": // shadowsocks
		conn.Close()
		return nil, errors.New("Not implemented")
	case "socks", "socks5":
		selector := &clientSelector{
			methods: []uint8{gosocks5.MethodNoAuth, gosocks5.MethodUserPass},
			arg:     forward,
		}
		if forward.EncMeth == "tls" {
			selector.methods = []uint8{MethodTLS, MethodTLSAuth}
		}
		c := gosocks5.ClientConn(conn, selector)
		if err := c.Handleshake(); err != nil {
			c.Close()
			return nil, err
		}
		conn = c

		host, port, _ := net.SplitHostPort(addr)
		p, _ := strconv.ParseUint(port, 10, 16)
		r := gosocks5.NewRequest(gosocks5.CmdConnect, &gosocks5.Addr{
			Type: gosocks5.AddrDomain,
			Host: host,
			Port: uint16(p),
		})
		rep, err := requestSocks5(conn, r)
		if err != nil {
			conn.Close()
			return nil, err
		}
		if rep.Rep != gosocks5.Succeeded {
			conn.Close()
			return nil, errors.New("Service unavailable")
		}
	case "http":
		fallthrough
	default:
		if connType == ConnHttpConnect || connType == ConnSocks5 {
			req := &http.Request{
				Method:     "CONNECT",
				URL:        &url.URL{Host: addr},
				Host:       addr,
				ProtoMajor: 1,
				ProtoMinor: 1,
				Header:     make(http.Header),
			}
			req.Header.Set("Proxy-Connection", "keep-alive")
			if forward.User != nil {
				req.Header.Set("Proxy-Authorization",
					"Basic "+base64.StdEncoding.EncodeToString([]byte(forward.User.String())))
			}
			if err = req.Write(conn); err != nil {
				conn.Close()
				return nil, err
			}
			if glog.V(LDEBUG) {
				dump, _ := httputil.DumpRequest(req, false)
				glog.Infoln(string(dump))
			}

			resp, err := http.ReadResponse(bufio.NewReader(conn), req)
			if err != nil {
				conn.Close()
				return nil, err
			}
			if glog.V(LDEBUG) {
				dump, _ := httputil.DumpResponse(resp, false)
				glog.Infoln(string(dump))
			}
			if resp.StatusCode != http.StatusOK {
				conn.Close()
				//log.Println(resp.Status)
				return nil, errors.New(resp.Status)
			}
		}
	}

	return
}