Issue #4: actually make it work
This commit is contained in:
1 parent
cfa06ec4bc
commit
cb57796dfc
2 files changed
+42
-53
No files matched your search
+12
-19
@@ -97,13 +97,11 @@ func readResponse(c net.Conn, fm fieldmap) (Response, error) {
|
||||
}
|
||||
|
||||
func readAID(c net.Conn) (AID, error) {
|
||||
buf := make([]byte, 1)
|
||||
for {
|
||||
_, err := telnetRead(c, buf)
|
||||
if err != nil {
|
||||
b, valid, _, err := telnetRead(c, false)
|
||||
if !valid && err != nil {
|
||||
return AIDNone, err
|
||||
}
|
||||
b := buf[0]
|
||||
if (b == 0x60) || (b >= 0x6b && b <= 0x6e) ||
|
||||
(b >= 0x7a && b <= 0x7d) || (b >= 0x4a && b <= 0x4c) ||
|
||||
(b >= 0xf1 && b <= 0xf9) || (b >= 0xc1 && b <= 0xc9) {
|
||||
@@ -117,15 +115,15 @@ func readAID(c net.Conn) (AID, error) {
|
||||
}
|
||||
|
||||
func readPosition(c net.Conn) (row, col, addr int, err error) {
|
||||
buf := make([]byte, 1)
|
||||
raw := make([]byte, 2)
|
||||
|
||||
// Read two bytes
|
||||
for i := 0; i < 2; i++ {
|
||||
if _, err := telnetRead(c, buf); err != nil {
|
||||
b, _, _, err := telnetRead(c, false)
|
||||
if err != nil {
|
||||
return 0, 0, 0, err
|
||||
}
|
||||
raw[i] = buf[0]
|
||||
raw[i] = b
|
||||
}
|
||||
|
||||
// Decode the raw position
|
||||
@@ -140,37 +138,32 @@ func readPosition(c net.Conn) (row, col, addr int, err error) {
|
||||
}
|
||||
|
||||
func readFields(c net.Conn, fm fieldmap) (map[string]string, error) {
|
||||
buf := make([]byte, 1)
|
||||
var infield bool
|
||||
var fieldpos int
|
||||
var fieldval bytes.Buffer
|
||||
var values = make(map[string]string)
|
||||
var err error
|
||||
|
||||
// consume bytes until we get 0xffef
|
||||
for {
|
||||
// Read a byte
|
||||
if _, err = telnetRead(c, buf); err != nil {
|
||||
b, _, eor, err := telnetRead(c, true)
|
||||
if err != nil {
|
||||
return nil, err
|
||||
}
|
||||
|
||||
// Check for end of data stream (0xffef)
|
||||
if buf[0] == 0xff {
|
||||
if eor {
|
||||
// Finish the current field
|
||||
if infield {
|
||||
debugf("Field %d: %s\n", fieldpos, e2a(fieldval.Bytes()))
|
||||
handleField(fieldpos, fieldval.Bytes(), fm, values)
|
||||
}
|
||||
|
||||
// consume the next byte, which is probably 0xef
|
||||
if _, err = telnetRead(c, buf); err != nil {
|
||||
return nil, err
|
||||
}
|
||||
return values, nil
|
||||
}
|
||||
|
||||
// No? Check for start-of-field
|
||||
if buf[0] == 0x11 {
|
||||
if b == 0x11 {
|
||||
// Finish the previous field, if necessary
|
||||
if infield {
|
||||
debugf("Field %d: %s\n", fieldpos, e2a(fieldval.Bytes()))
|
||||
@@ -189,10 +182,10 @@ func readFields(c net.Conn, fm fieldmap) (map[string]string, error) {
|
||||
|
||||
// Consume all other bytes as field contents if we're in a field
|
||||
if !infield {
|
||||
debugf("Got unexpected byte while processing fields: %02x\n", buf[0])
|
||||
debugf("Got unexpected byte while processing fields: %02x\n", b)
|
||||
continue
|
||||
}
|
||||
fieldval.WriteByte(buf[0])
|
||||
fieldval.WriteByte(b)
|
||||
}
|
||||
}
|
||||
|
||||
@@ -212,7 +205,7 @@ func handleField(addr int, value []byte, fm fieldmap, values map[string]string)
|
||||
// decodeBufAddr decodes a raw 2-byte encoded buffer address and returns the
|
||||
// integer value of the address (i.e. 0-1919)
|
||||
func decodeBufAddr(raw [2]byte) int {
|
||||
if decodes[raw[0]]<<6 > 254 {
|
||||
if decodes[raw[0]] > 254 {
|
||||
fmt.Fprintf(os.Stderr,
|
||||
"UNEXPECTED VALUE: decodeBufAddr got raw value of %02x %02x\n",
|
||||
raw[0], raw[1])
|
||||
|
||||
@@ -20,7 +20,8 @@ const (
|
||||
dont = 254 // fe
|
||||
iac = 255 // ff
|
||||
terminalType = 24 // 18
|
||||
eor = 25 // 19
|
||||
eoroption = 25 // 19
|
||||
eor = 239 // f1
|
||||
)
|
||||
|
||||
// NegotiateTelnet will naively (e.g. not checking client responses) negotiate
|
||||
@@ -28,9 +29,9 @@ const (
|
||||
func NegotiateTelnet(conn net.Conn) error {
|
||||
conn.Write([]byte{iac, do, terminalType})
|
||||
conn.Write([]byte{iac, sb, terminalType, send, iac, se})
|
||||
conn.Write([]byte{iac, do, eor})
|
||||
conn.Write([]byte{iac, do, eoroption})
|
||||
conn.Write([]byte{iac, do, binary})
|
||||
conn.Write([]byte{iac, will, eor, iac, will, binary})
|
||||
conn.Write([]byte{iac, will, eoroption, iac, will, binary})
|
||||
flushConnection(conn, time.Second*5)
|
||||
return nil
|
||||
}
|
||||
@@ -39,9 +40,9 @@ func NegotiateTelnet(conn net.Conn) error {
|
||||
// to restore the telnet options state to what it was before NegotiateTelnet()
|
||||
// was called.
|
||||
func UnNegotiateTelnet(conn net.Conn, timeout time.Duration) error {
|
||||
conn.Write([]byte{iac, wont, eor, iac, wont, binary})
|
||||
conn.Write([]byte{iac, wont, eoroption, iac, wont, binary})
|
||||
conn.Write([]byte{iac, dont, binary})
|
||||
conn.Write([]byte{iac, dont, eor})
|
||||
conn.Write([]byte{iac, dont, eoroption})
|
||||
conn.Write([]byte{iac, dont, terminalType})
|
||||
flushConnection(conn, timeout)
|
||||
return nil
|
||||
@@ -69,30 +70,32 @@ func flushConnection(conn net.Conn, timeout time.Duration) error {
|
||||
}
|
||||
}
|
||||
|
||||
// telnetRead behaves similarly to conn.Read, except it filters out telnet
|
||||
// commands. A single call to telnetRead() may perform multiple calls to
|
||||
// c.Read() if awaiting completion of a command, or to ensure we do not return
|
||||
// zero bytes in a non-error condition.
|
||||
func telnetRead(c net.Conn, p []byte) (n int, err error) {
|
||||
// telnetRead returns the next byte of data from the connection c, but
|
||||
// filters out all telnet commands. If passEOR is true, then telnetRead will
|
||||
// return upon encountering the telnet End of Record command, setting isEor to
|
||||
// true. When isEor is true, the value of b is meaningless and must be ignored
|
||||
// (valid will be false). When valid is true, the value in byte b is a real
|
||||
// value read from the connection; when value is false, do not use the value
|
||||
// in b. (For example, a valid byte AND error can be returned in the same
|
||||
// call.)
|
||||
func telnetRead(c net.Conn, passEOR bool) (b byte, valid, isEor bool, err error) {
|
||||
const (
|
||||
normal = iota
|
||||
command
|
||||
subneg
|
||||
)
|
||||
|
||||
// Not the most efficient, but for now to keep the code easier we'll just
|
||||
// read 1 byte at a time from the connection.
|
||||
b := make([]byte, 1)
|
||||
buf := make([]byte, 1)
|
||||
state := normal
|
||||
|
||||
for n < len(p) {
|
||||
bn, berr := c.Read(b)
|
||||
for {
|
||||
bn, berr := c.Read(buf)
|
||||
|
||||
// When there are no bytes to process and we received an error, we
|
||||
// are done no matter what state we're in. Any non-command bytes will
|
||||
// already be in p, so we return.
|
||||
if bn == 0 && berr != nil {
|
||||
return n, berr
|
||||
return 0, false, false, berr
|
||||
}
|
||||
|
||||
// If we received 0 bytes but no error, we'll just read again.
|
||||
@@ -103,42 +106,35 @@ func telnetRead(c net.Conn, p []byte) (n int, err error) {
|
||||
// We got a byte! Let's progress through our state machine.
|
||||
switch state {
|
||||
case normal:
|
||||
if b[0] == iac {
|
||||
if buf[0] == iac {
|
||||
state = command
|
||||
debugf("entering telnet command state\n")
|
||||
} else {
|
||||
p[n] = b[0]
|
||||
n++
|
||||
return buf[0], true, false, berr
|
||||
}
|
||||
case command:
|
||||
if b[0] == 0xff {
|
||||
p[n] = 0xff
|
||||
n++
|
||||
state = normal
|
||||
if buf[0] == 0xff {
|
||||
debugf("leaving telnet command state; was an escaped 0xff\n")
|
||||
} else if b[0] == sb {
|
||||
return 0xff, true, false, nil
|
||||
} else if buf[0] == sb {
|
||||
state = subneg
|
||||
debugf("entering telnet command subnegotiation state\n")
|
||||
} else if passEOR && buf[0] == eor {
|
||||
debugf("leaving telnet command state; returning EOR\n")
|
||||
return 0, false, true, nil
|
||||
} else {
|
||||
state = normal
|
||||
debugf("leaving telnet command state; command was %02x\n",
|
||||
b[0])
|
||||
buf[0])
|
||||
}
|
||||
case subneg:
|
||||
if b[0] == se {
|
||||
if buf[0] == se {
|
||||
state = normal
|
||||
debugf("leaving telnet command subnegotiation state\n")
|
||||
} else {
|
||||
// remain in subnegotiation consuming bytes until we get se
|
||||
debugf("consumed telnet subnegotiation byte: %02x\n", b[0])
|
||||
debugf("consumed telnet subnegotiation byte: %02x\n", buf[0])
|
||||
}
|
||||
}
|
||||
|
||||
// Now we handle any errors that returned partial data
|
||||
if berr != nil {
|
||||
return n, berr
|
||||
}
|
||||
}
|
||||
|
||||
return n, nil
|
||||
}
|
||||
Reference in new issue
Block a user