status-go/vendor/github.com/koron/go-ssdp/advertise.go

package ssdp

import (
	"bufio"
	"bytes"
	"fmt"
	"io"
	"net"
	"net/http"
	"sync"
)

type message struct {
	to   net.Addr
	data []byte
}

// Advertiser is a server to advertise a service.
type Advertiser struct {
	st       string
	usn      string
	location string
	server   string
	maxAge   int

	conn *multicastConn
	ch   chan *message
	wg   sync.WaitGroup
	quit chan bool
}

// Advertise starts advertisement of service.
func Advertise(st, usn, location, server string, maxAge int) (*Advertiser, error) {
	conn, err := multicastListen(recvAddrIPv4)
	if err != nil {
		return nil, err
	}
	logf("SSDP advertise on: %s", conn.LocalAddr().String())
	a := &Advertiser{
		st:       st,
		usn:      usn,
		location: location,
		server:   server,
		maxAge:   maxAge,
		conn:     conn,
		ch:       make(chan *message),
		quit:     make(chan bool),
	}
	a.wg.Add(2)
	go func() {
		a.sendMain()
		a.wg.Done()
	}()
	go func() {
		a.serve()
		a.wg.Done()
	}()
	return a, nil
}

func (a *Advertiser) serve() error {
	err := a.conn.readPackets(0, func(addr net.Addr, data []byte) error {
		select {
		case _ = <-a.quit:
			return io.EOF
		default:
		}
		if err := a.handleRaw(addr, data); err != nil {
			logf("failed to handle message: %s", err)
		}
		return nil
	})
	if err != nil && err != io.EOF {
		return err
	}
	return nil
}

func (a *Advertiser) sendMain() error {
	for {
		select {
		case msg, ok := <-a.ch:
			if !ok {
				return nil
			}
			_, err := a.conn.WriteTo(msg.data, msg.to)
			if err != nil {
				if nerr, ok := err.(net.Error); !ok || !nerr.Temporary() {
					logf("failed to send: %s", err)
				}
			}
		case _ = <-a.quit:
			return nil
		}
	}
}

func (a *Advertiser) handleRaw(from net.Addr, raw []byte) error {
	if !bytes.HasPrefix(raw, []byte("M-SEARCH ")) {
		// unexpected method.
		return nil
	}
	req, err := http.ReadRequest(bufio.NewReader(bytes.NewReader(raw)))
	if err != nil {
		return err
	}
	var (
		man = req.Header.Get("MAN")
		st  = req.Header.Get("ST")
	)
	if man != `"ssdp:discover"` {
		return fmt.Errorf("unexpected MAN: %s", man)
	}
	if st != All && st != RootDevice && st != a.st {
		// skip when ST is not matched/expected.
		return nil
	}
	logf("received M-SEARCH MAN=%s ST=%s from %s", man, st, from.String())
	// build and send a response.
	msg, err := buildOK(a.st, a.usn, a.location, a.server, a.maxAge)
	if err != nil {
		return err
	}
	a.ch <- &message{to: from, data: msg}
	return nil
}

func buildOK(st, usn, location, server string, maxAge int) ([]byte, error) {
	b := new(bytes.Buffer)
	// FIXME: error should be checked.
	b.WriteString("HTTP/1.1 200 OK\r\n")
	fmt.Fprintf(b, "ST: %s\r\n", st)
	fmt.Fprintf(b, "USN: %s\r\n", usn)
	if location != "" {
		fmt.Fprintf(b, "LOCATION: %s\r\n", location)
	}
	if server != "" {
		fmt.Fprintf(b, "SERVER: %s\r\n", server)
	}
	fmt.Fprintf(b, "CACHE-CONTROL: max-age=%d\r\n", maxAge)
	b.WriteString("\r\n")
	return b.Bytes(), nil
}

// Close stops advertisement.
func (a *Advertiser) Close() error {
	if a.conn != nil {
		// closing order is very important. be caraful to change.
		close(a.quit)
		a.conn.Close()
		a.wg.Wait()
		close(a.ch)
		a.conn = nil
	}
	return nil
}

// Alive announces ssdp:alive message.
func (a *Advertiser) Alive() error {
	msg, err := buildAlive(ssdpAddrIPv4, a.st, a.usn, a.location, a.server,
		a.maxAge)
	if err != nil {
		return err
	}
	a.ch <- &message{to: ssdpAddrIPv4, data: msg}
	logf("sent alive")
	return nil
}

// Bye announces ssdp:byebye message.
func (a *Advertiser) Bye() error {
	msg, err := buildBye(ssdpAddrIPv4, a.st, a.usn)
	if err != nil {
		return err
	}
	a.ch <- &message{to: ssdpAddrIPv4, data: msg}
	logf("sent bye")
	return nil
}