<?php

namespace TelnetClient;

require_once('AnsiAsciiControlParser.php');

use \AnsiAsciiControlParser;


class UnimplementedException extends \ErrorException {
}

class NameResolutionException extends \InvalidArgumentException {
}

class ConnectionException extends \RuntimeException {
}

class ConnectionTimeoutException extends ConnectionException {
}

class LoginException extends \RuntimeException {
}

class UnlikelyException extends \ErrorException {
}

error_reporting(E_ALL ^ E_WARNING);

class TelnetClient {
	/* NVT special characters
	 * specified in the same order as in RFC854
	 * same name as there, with a NVT_ prefix (to avoid clash with PHP keywords)
	 */

	// Codes that have special meaning to the NVT Printer
	const NVT_NUL  = "\x00";
	const NVT_LF   = "\n"; //"\x0A";
	const NVT_CR   = "\r"; //"\x0D";

	const NVT_BEL  = "\x07";
	const NVT_BS   = "\x08";
	const NVT_HT   = "\x09";
	const NVT_VT   = "\x0B";
	const NVT_FF   = "\x0C";

	/* TELNET command characters
	 * "Note that these codes and code sequences have the indicated meaning
	 * only when immediately preceded by an IAC." RFC854
	 */
	/* RFC1123:
	 * MUST:   SE, NOP, DM, IP, AO, AYT, SB
	 * SHOULD: EOR, EC, EL, BRK
	 */
	const CMD_SE   = "\xF0"; //Subnegotiation End
	const CMD_NOP  = "\xF1";
	const CMD_DM   = "\xF2"; //Data Mark
	const CMD_BRK  = "\xF3"; //Break
	const CMD_IP   = "\xF4"; //Interrupt Process
	const CMD_AO   = "\xF5"; //Abort Output
	const CMD_AYT  = "\xF6"; //Are You There
	const CMD_EC   = "\xF7"; //Erase Character
	const CMD_EL   = "\xF8"; //Erase Line
	const CMD_GA   = "\xF9"; //Go Ahead
	const CMD_SB   = "\xFA"; //Subnegotiation (start)
	const CMD_WILL = "\xFB";
	const CMD_WONT = "\xFC";
	const CMD_DO   = "\xFD";
	const CMD_DONT = "\xFE";
	const CMD_IAC  = "\xFF"; //Interpret As Command

	const OPT_TXBIN     = "\x00"; //Transmit binary, RFC856
	const OPT_ECHO      = "\x01"; //Echo, RFC857
	const OPT_SGA       = "\x03"; //Suppress Go Ahead, RFC858 (makes connection full-duplex instead of half-duplex)
	const OPT_STATUS    = "\x05"; //Status, RFC859
	const OPT_TIMMRK    = "\x06"; //Timing Mark, RFC860
	const OPT_EXTOPL    = "\xFF"; //Extended options list, RFC861
	const OPT_EOR       = "\x19"; //25, End of record, RFC885
	const OPT_3270_R    = "\x1D"; //29, 3270 Regimes (?), RFC1041
	const OPT_NAWS      = "\x1F"; //31, Negotiate About Window Size, RFC1073
	const OPT_TERMSPD   = "\x20"; //32, Terminal speed, RFC1079
	const OPT_TERMTYP   = "\x18"; //24, Terminal type, RFC1091
	const OPT_XDISPLOC  = "\x23"; //35, X Display Location, RFC1096
	const OPT_LINEMODE  = "\x22"; //34, Linemode, RFC1116
	const OPT_NEW_ENV   = "\x27"; //39, New environment variable, RFC1572
	const OPT_R_FLW_CTR = "\x21"; //33, Remote Flow Control, RFC1080

	const STATE_DEFAULT = 0;
	const STATE_CMD = 1;

	const TELNET_ERROR = false;
	const TELNET_OK = true;


	private static $DEBUG = false;

	private static $NVTP_SPECIALS = array(
			self::NVT_NUL  => 'NUL',
			self::NVT_LF   => 'LF',
			self::NVT_CR   => 'CR',
			self::NVT_BEL  => 'BEL',
			self::NVT_BS   => 'BS',
			self::NVT_HT   => 'HT',
			self::NVT_VT   => 'VT',
			self::NVT_FF   => 'FF',
			);

	private static $CMDS = array(
			self::CMD_SE   => 'SE',
			self::CMD_NOP  => 'NOP',
			self::CMD_DM   => 'DM',
			self::CMD_BRK  => 'BRK',
			self::CMD_IP   => 'IP',
			self::CMD_AO   => 'AO',
			self::CMD_AYT  => 'AYT',
			self::CMD_EC   => 'EC',
			self::CMD_EL   => 'EL',
			self::CMD_GA   => 'GA',
			self::CMD_SB   => 'SB',
			self::CMD_WILL => 'WILL',
			self::CMD_WONT => 'WONT',
			self::CMD_DO   => 'DO',
			self::CMD_DONT => 'DONT',
			self::CMD_IAC  => 'IAC'
			);

	private static $OPTS = array(
			self::OPT_TXBIN     => 'Transmit Binary',
			self::OPT_ECHO      => 'Echo',
			self::OPT_SGA       => 'Suppress Go Ahead',
			self::OPT_STATUS    => 'Status',
			self::OPT_TIMMRK    => 'Timing Mark',
			self::OPT_EXTOPL    => 'Extended Options List',
			self::OPT_EOR       => 'End Of Record',
			self::OPT_3270_R    => '3270-Regime',
			self::OPT_NAWS      => 'Negotiate About Window Size',
			self::OPT_TERMSPD   => 'Terminal Speed',
			self::OPT_TERMTYP   => 'Terminal Type',
			self::OPT_XDISPLOC  => 'X Display Location',
			self::OPT_LINEMODE  => 'Linemode',
			self::OPT_NEW_ENV   => 'New Environment',
			self::OPT_R_FLW_CTR => 'Remote Flow Control'
			);


	private $host;
	private $ip_address;
	private $port;
	private $connect_timeout; //Timeout to connect to remote
	private $socket_timeout; //Timeout to wait for data
	private $full_line_timeout; //Timeout to wait for a full line
	private $state;
	private $do_get_remaining_data;
	private $socket;
	private $regex_prompt;
	private $errno;
	private $errstr;
	private $has_go_ahead;
	private $ctrlcharparser;
	private $pruneCtrlSeq;


	/**
	 * Toggle debugging for code defined in this class only
	 *
	 * Ideally, this would work if subclasses
	 * defined only their own static $DEBUG field, but the parent
	 * class doesn't have access to children's private fields (unsurprisingly)
	 *
	 * Therefore, child classes need to define both their own $DEBUG field AND
	 * copy this method. This seems to be the cleanest way to do it as
	 * it breaks cleanly if a child class doesn't do it
	 */
	public static function setDebug($enable) {
		static::$DEBUG = !!$enable;
	}


	/**
	 * Translates codes to user-readable strings.
	 *
	 * @param string $code the code to translate
	 * @param string[] $CODE_LIST an array of $code => string
	 *
	 * @return string A user-readable string ("0x<hexstring>" is returned for unknown keys)
	 */
	private static function getCodeStrOrHexStr($code, $CODE_LIST) {
		if (array_key_exists($code, $CODE_LIST)) {
			return $CODE_LIST[$code];
		}

		return '0x' . bin2hex($code);
	}


	/**
	 * Get a user-readable string for NVT special characters
	 *
	 * Example: getNvtPrintSpecialStr(TelnetClient::NVT_NUL) prints "NUL"
	 *
	 * @param string the code to translate
	 * @return string a printable representation of the code ("0x<hexstring> is returned for unknown codes)
	 */
	public static function getNvtPrintSpecialStr($code) {
		return self::getCodeStrOrHexStr($code, self::$NVTP_SPECIALS);
	}


	/**
	 * Get a user-readable string for TELNET command characters
	 *
	 * Example: getNvtPrintSpecialStr(TelnetClient::CMD_IAC)
	 * Note: The user-readable strings are not guaranteed to be stable
	 *
	 * @param string the code to translate
	 * @return string a printable representation of the code ("0x<hexstring> is returned for unknown codes)
	 */
	public static function getCmdStr($code) {
		return self::getCodeStrOrHexStr($code, self::$CMDS);
	}


	/**
	 * Get a user-readable string for TELNET option characters
	 *
	 * Example: getNvtPrintSpecialStr(TelnetClient::OPT_ECHO)
	 * Note: The user-readable strings are not guaranteed to be stable
	 *
	 * @param string the code to translate
	 * @return string a printable representation of the code ("0x<hexstring> is returned for unknown codes)
	 */
	public static function getOptStr($code) {
		return self::getCodeStrOrHexStr($code, self::$OPTS);
	}


	/**
	 * Constructor. Initialises host, port and timeout parameters
	 * defaults to localhost port 23 (standard telnet port)
	 *
	 * @param string $host Host name or IP addres
	 * @param int $port TCP port number
	 * @param float $connect_timeout the timeout for connecting to the host
	 * @param string $prompt the default prompt
	 * @param float|null $socket_timeout the timeout to wait for new data (null = infinite)
	 * @throws \InvalidArgumentException if an argument is invalid
	 */
	public function __construct($host = '127.0.0.1', $port = 23, $connect_timeout = 1.0, $socket_timeout = 10.0, $prompt = '$', $full_line_timeout = 0.10) {
		$this->host = $host;

		$this->port = $port;

		$this->setConnectTimeout($connect_timeout);
		$this->setSocketTimeout($socket_timeout);
		$this->setFullLineTimeout($full_line_timeout);
		$this->setPrompt($prompt);

		$this->state = self::STATE_DEFAULT;
		$this->do_get_remaining_data = true;
		$this->has_go_ahead = false; //By default the server speaks first (?)
		$this->cntrlcharparser = new AnsiAsciiControlParser();
		$this->pruneCtrlSeq = false;
	}


	/**
	 * Destructor. Cleans up socket connection and command buffer
	 *
	 * @return void
	 */
	public function __destruct() {
		// clean up resources
		$this->disconnect();
	}


	/**
	 * Attempts connection to remote host.
	 *
	 * @return boolean true if successful
	 * @throws NameResolutionException on error
	 * @throws ConnectionException on error
	 */
	public function connect() {
		$this->ip_address = gethostbyname($this->host);

		if (filter_var($this->ip_address, FILTER_VALIDATE_IP) === false) {
			throw new NameResolutionException("Cannot resolve $this->host");
		}

		// attempt connection - suppress warnings
		$this->socket = @fsockopen($this->ip_address, $this->port, $this->errno, $this->errstr, $this->connect_timeout);
		if ($this->socket === false) {
			throw new ConnectionException("Cannot connect to $this->host on port $this->port (errno={$this->errno} errstr='{$this->errstr}')");
		}
		stream_set_blocking($this->socket, 0);

		return self::TELNET_OK;
	}


	/**
	 * Closes IP socket
	 *
	 * @return boolean
	 * @throws UnlikelyException if closing the socket failed
	 */
	public function disconnect() {
		if (is_resource($this->socket)) {
			if (fclose($this->socket) === false) {
				throw new UnlikelyException("Error while closing telnet socket");
			}
			$this->socket = null;
		}
		return self::TELNET_OK;
	}


	/**
	 * @deprecated please use setSocketTimeout($socket_timeout)
	 */
	public function setStreamTimeout($socket_timeout) {
		return $this->setSocketTimeout($socket_timeout);
	}


	/**
	 * @param float|null $socket_timeout the timeout to wait for new data (null = infinite)
	 * @return void
	 * @throws \InvalidArgumentException if $socket_timeout is of the wrong type or value
	 */
	public function setSocketTimeout($socket_timeout) {
		if (!(is_null($socket_timeout)
				|| ((is_float($socket_timeout) && $socket_timeout >= 0.0)))) {
			throw new \InvalidArgumentException('socket_timeout must be non-negative float or null');
		}
		$this->socket_timeout = $socket_timeout;
	}


	/**
	 * Returns the time, in seconds, to wait between characters (when waiting for new data) before timing out
	 *
	 * @return float|null the current socket timeout (null = infinite)
	 */
	public function getSocketTimeout() {
		return $this->socket_timeout;
	}


	/**
	 * @return float|null the timeout for a full line
	 * @see setFullLineTimeout()
	 */
	public function getFullLineTimeout() {
		return $this->full_line_timeout;
	}


	/**
	 * @param float|null $full_line_timeout The maximum time to wait for before
	 *      assuming the line is not carriage return terminated. null for infinity
	 *
	 * Note: Setting a timeout value larger than socket timeout is probably a bad idea
	 */
	public function setFullLineTimeout($full_line_timeout) {
		if (!(is_null($full_line_timeout)
				|| (is_float($full_line_timeout) && $full_line_timeout >= 0.0))) {
			throw new \InvalidArgumentException('full_line_timeout must be null or non-negative float');
		}
		$this->full_line_timeout = $full_line_timeout;
	}


	public function getPruneCtrlSeq() {
		return $this->pruneCtrlSeq;
	}


	public function setPruneCtrlSeq($enable) {
		$this->pruneCtrlSeq = !!$enable;
	}


	/**
	 * @return string the hostname (as passed to the ctor) to connect to
	 */
	public function getHostname() {
		return $this->host;
	}


	/**
	 * @return string the IP address the hostname was last resolved to
	 */
	public function getIpAddress() {
		return $this->ip_address;
	}


	/**
	 * @return float the connect timeout
	 * @see self::setConnectTimeout()
	 */
	public function getConnectTimeout() {
		return $this->connectTimeout;
	}


	/**
	 * @param float $connect_timeout the timeout, in seconds, to wait for the socket connection/TCP handshake
	 * @return void
	 * @throws \InvalidArgumentException if $connect_timeout is not float or is negative
	 */
	public function setConnectTimeout($connect_timeout) {
		if (!(is_float($connect_timeout) && $connect_timeout >= 0.0)) {
			throw new \InvalidArgumentException('connect_timeout must be float');
		}
		$this->connect_timeout = $connect_timeout;
	}


	/**
	 * Executes command and returns a string with result.
	 *
	 * @param string $command Command to execute
	 * @param boolean $add_newline Default true, adds newline to the command
	 * @return string Command result
	 */
	public function exec($command, $add_newline = true) {
		$this->sendCommand($command, $add_newline);
		$a_line = $this->waitPrompt($this->do_get_remaining_data);

		return $a_line;
	}


	public function sendCommand($command, $add_newline = true) {
		//TODO: Pass $command into the state machine to escape IACs, also look at UTF-8 RFC about how to escape newlines
		$this->write($command, $add_newline);
	}


	/**
	 * @param boolean $matchesPrompt reference set to true if the line matches the prompt, false otherwise
	 * @param boolean $waitForFullLine true to wait indefinitely for a full
	 *     line ("\n" terminated). False waits for up to fullLineTimeout before returning
	 *
	 * @return string|false The line as a string with its terminating "\n".
	 *     In "non-full line" mode, the line may be incomplete or false (if no character is available)
	 */
	public function getLine(&$matchesPrompt, $waitForFullLine = true) {
		$waitForFullLine = !!$waitForFullLine;

		do {
			$line = $this->getNextLine();
		} while ($waitForFullLine && $line === false);
		$matchesPrompt = $this->matchesPrompt($line);
		return $line;
	}


	/**
	 * Discards unread but received data, processing options if any
	 */
	public function discardRemainingData() {
		$this->getRemainingData();
	}


	/**
	 * Attempts login to remote host.
	 *
	 * @param string $username Username
	 * @param string $password Password
	 * @param string|null $login_prompt the string to look for before sending the username (null to skip)
	 * @param string|null $password_prompt the string to look for before sending the password (null to skip)
	 * @return boolean
	 * @throws LoginException on error
	 */
	public function login($username, $password, $login_prompt = 'login:', $password_prompt = 'Password:') {
		$prompt = $this->regex_prompt;
		try {
			if (!is_null($login_prompt)) {
				$this->setPrompt($login_prompt);
				$this->waitPrompt($this->do_get_remaining_data);
				$this->write($username);
			}

			if (!is_null($password_prompt)) {
				$this->setPrompt($password_prompt);
				$this->waitPrompt($this->do_get_remaining_data);
				$this->write($password);
			}

			//Reset prompt
			$this->regex_prompt = $prompt;

			$this->waitPrompt($this->do_get_remaining_data);
		} catch (\Exception $e) {
			throw new LoginException("Login failed", 0, $e);
		}

		return self::TELNET_OK;
	}


	/**
	 * @param boolean $enable true if all remaining data is to be fetched after the prompt is found, false otherwise
	 * @return void
	 */
	public function setDoGetRemainingData($enable) {
		$this->do_get_remaining_data = !!$enable;
	}


	/**
	 * @return boolean true if all remaining data is to be fetched after the prompt is found, false otherwise
	 */
	public function getDoGetRemainingData() {
		return $this->do_get_remaining_data;
	}


	/**
	 * Sets the string of characters to respond to.
	 * This should be set to the last character of the command line prompt
	 *
	 * @param string $str String to respond to
	 * @return boolean true on success
	 */
	public function setPrompt($str = '$') {
		return $this->setRegexPrompt(preg_quote($str, '/'));
	}


	/**
	 * @return string the current regex prompt without the enclosing
	 *   slashes and $ metacharacter
	 * @see self::setRegexPrompt()
	 */
	public function getRegexPrompt() {
		return $this->regex_prompt;
	}


	/**
	 * Sets a regex string to respond to.
	 * This should be set to the last line of the command line prompt.
	 *
	 * Note: The actual regex is "/{$str}$/", so you will need to escape slashes
	 * and must not include a $ metacharacter
	 *
	 * @param string $str Regex string to respond to
	 * @return boolean true on success
	 * @throws \InvalidArgumentException if the regex doesn't compile
	 */
	public function setRegexPrompt($str = '\$') {
		$this->regex_prompt = $str;

		if (false === preg_match("/{$this->regex_prompt}$/", '')) {
			throw new \InvalidArgumentException('Malformed PCRE error');
		}

		return self::TELNET_OK;
	}


	private function asyncGetc() {
		$c = fgetc($this->socket);
		return $c;
	}


	/**
	 * @deprecated please use waitForNbData(1);
	 * Note: This function doesn't add the returned characters to the buffer nor the global buffer
	 */
	protected function getc() {
		$c = $this->waitForNbData(1);
		return $c;
	}


	/**
	 * Reads up to $length bytes of data (TELNET commands are not counted) or wait for $this->socket_timeout seconds, whichever occurs first
	 *
	 * @param int|null $length maximum number of data bytes to read. Either a non-negative int or null (infinite length)
	 *
	 * @return string the raw data read as a string
	 * @throws \InvalidArgumentException if $length is neither null nor int
	 * @throws \InvalidArgumentException if $length is int and smaller than 1
	 * @throws \InvalidArgumentException if $length is null and socket_timeout is null
	 */
	private function waitForNbData($length = null) {
		if (is_null($length) && is_null($this->socket_timeout)) {
			throw new \InvalidArgumentException('Would wait infinitely');
		} else if (!is_null($length) && (!is_int($length) || $length < 1)) {
			throw new \InvalidArgumentException('$length must be a positive int');
		}

		$cb = function ($nbchar, $c, $length) {
					//FIXME: This is wrong: if we get IAC in the middle, we will never return
					return is_null($length) || $nbchar < $length;
				};

		return $this->getMoreData($cb, $length);
	}


	private function _getNextLine_cb($nbchar, $c, &$firstCharTs) {
		if (is_null($firstCharTs)) {
			if ($c !== false) {
				$firstCharTs = microtime(true);
			}
		} else if ($c === "\n") {
			return false;
		} else if (!is_null($this->full_line_timeout) && $firstCharTs + $this->full_line_timeout <= microtime(true)) {
			return false;
		}

		//if ($c !== false) {
		//	var_dump(microtime(true));
		//	var_dump($c);
		//}
		return $c !== "\n";
	}


	/**
	 */
	private function getNextLine() {
		$line = $this->getMoreData(array($this, '_getNextLine_cb'));

		if ($line !== false && $this->pruneCtrlSeq) {
			$this->cntrlcharparser->parse($line);
			$line = $this->cntrlcharparser->getTextString();
		}

		return $line;
	}


	private function getRemainingData() {
		$cb = function ($nbchar, $c, $userData) {
					return $c !== false;
				};

		$data = $this->getMoreData($cb);

		if ($data !== false && $this->pruneCtrlSeq) {
			$this->cntrlcharparser->parse($data);
			$data = $this->cntrlcharparser->getTextString();
		}

		return $data;
	}


	/**
	 * @param callable $get_more_data_cb boolean get_more_data_cb(numberOfCharactersInTheArray, lastCharacter, userData), $c will be false if no character is no more characters are available at the moment
	 * @param mixed $userData a user parameter passed to the callable
	 * @throws ConnectionTimeoutException
	 *
	 * @return string|false the data received or false if none
	 */
	private function getMoreData($get_more_data_cb, $userData = null) {
		$data = false;
		$endTs = microtime(true) + $this->socket_timeout;
		$a_c = array();
		$c = null;
		$is_get_more_data = null;
		do {
			$c = $this->asyncGetc();
			if ($c === false) {
				usleep(5);
				if (!is_null($this->socket_timeout) && microtime(true) > $endTs) {
					throw new ConnectionTimeoutException("Timed out");
				}
				continue;
			} else {
				//Reset the timeout
				$endTs = microtime(true) + $this->socket_timeout;
			}
			$a_c[] = $c;

			$is_get_more_data = $this->processStateMachine($a_c);
			if (!$is_get_more_data && count($a_c) > 0) {
				if ($data === false) {
					$data = '';
				}
				$new_data = implode($a_c);
				if (self::$DEBUG) {
					print("Adding " . (ctype_print($new_data) ? "\"{$new_data}\"" : "(0x" . bin2hex($new_data) . ")") . " to buffer\n");
					//print("Adding \"{$new_data}\" (0x" . bin2hex($new_data) . ") to buffer (count = " . count($a_c) . " len = " . strlen($new_data) . ")\n");
					//var_dump($a_c);
				}
				$data .= $new_data;
				$a_c = array();
			}
		} while ($is_get_more_data || call_user_func_array($get_more_data_cb, array(count($data), $c, &$userData)));

		return $data;
	}


	/**
	 * This function processes the stream received (passed as an array of NVT characters) and filters TELNET protocol data out.
	 * It is meant to be called once each time a new character is added to the array. The array can only be said to contain data once the return code is false
	 *
	 * @param array $a_c array of characters to process.
	 * @return boolean true if more characters are needed, false if processing is done ($a_c was cleaned of TELNET protocol data such that it contains only actual data)
	 * @throws UnimplementedException on unknown state
	 */
	private function processStateMachine(array &$a_c) {
		$is_get_more_data = false;

		switch ($this->state) {
		case self::STATE_DEFAULT:
			$is_get_more_data = $this->processStateMachineDefaultState($a_c);
			break;
		case self::STATE_CMD:
			$is_get_more_data = $this->processStateMachineCmdState($a_c);
			break;
		//case self::STATE_BINARY:
		//	break;
		//case self::STATE_OPT:
		//	break;
		//case self::STATE_NEG_NO:
		//	break;
		//case self::STATE_NEG_YES:
		//	break;
		default:
			throw new UnimplementedException("Unimplement state {$this->state}");
			break;
		}

		return $is_get_more_data;
	}


	/**
	 * Processes the default state, should only be called from processStateMachine()
	 *
	 * @param array $a_c array of characters to process.
	 * @return boolean true if more characters are needed, false if processing is done ($a_c was cleaned of TELNET protocol data such that it contains only actual data)
	 */
	private function processStateMachineDefaultState(array &$a_c) {
		$is_get_more_data = false;

		switch ($a_c[0]) {
		case self::CMD_IAC:
			if (count($a_c) < 2) {
				$is_get_more_data = true;
				break;
			}
			$cmd = $a_c[1];
			if ($cmd === self::CMD_IAC) {
				/* Is this supposed to happen in normal mode? (Yes,
				 * "With the current set-up, only the IAC need be doubled to be sent as data" --RFC854) */

				//Add (only) one IAC character to the data
				$is_get_more_data = false;
				$a_c = array(self::CMD_IAC);

			} else {
				$is_get_more_data = true;
				$this->state = self::STATE_CMD;
			}
			break;

		case self::NVT_CR:
			if (count($a_c) < 2) {
				$is_get_more_data = true;
			} else {
				switch ($a_c[1]) {
				case self::NVT_LF:
					//Replace <CR> <LF> by "\n" (only in STATE_DEFAULT)
					$a_c = array("\n");
					break;
				}
			}
			break;
		default:
			//Pass, raw data
		}

		return $is_get_more_data;
	}


	/**
	 * Processes the command state, should only be called from processStateMachine()
	 *
	 * @param array $a_c array of characters to process.
	 * @return boolean true if more characters are needed, false if processing is done ($a_c was cleaned of TELNET protocol data such that it contains only actual data)
	 * @throws ConnectionException if sending command negotiation fails
	 */
	private function processStateMachineCmdState(array &$a_c) {
		$is_get_more_data = false;

		if (count($a_c) < 3) {
			//Get more data
			$is_get_more_data = true;

		} else if ($a_c[0] !== self::CMD_IAC) {
			//Pass;

		} else {
			$cmd = $a_c[1];
			$opt = $a_c[2];
			$reply_cmd = null;
			switch ($cmd) {
			case self::CMD_SB:
				if ($opt === self::CMD_SE) {
					//Empty subnegotiation?! (pass)
				} else if (end($a_c) !== self::CMD_SE) {
					//Get more data
					$is_get_more_data = true;
				} else {
					//TODO: Handle subnegotiation here
					if (self::$DEBUG) {
						print("Silently dropping subnegotiation (to be implemented)\n");
					}
				}
				break;

			//TODO: Handle other commands
			case self::CMD_DO: //FALLTHROUGH
			case self::CMD_DONT:
				$reply_cmd = self::CMD_WONT;
				break;

			case self::CMD_WILL:
				$reply_cmd = self::CMD_DONT;
				break;
			case self::CMD_WONT:
				//Pass, we are not supposed to "acknowledge" WONTs
				//TODO: Reread the Q method RFC, I don't remember if this is right
				break;

			default:
				if (self::$DEBUG) {
					print('Ignoring unknown command ' . self::getCmdStr($cmd) . "\n");
				}
			}

			if (!is_null($reply_cmd)) {
				$buffer = self::CMD_IAC . $reply_cmd . $opt;
				$ret = fwrite($this->socket, $buffer);
				if ($ret !== strlen($buffer)) { //|| $ret === false) {
					throw new ConnectionException("Error writing to socket");
				}

				if (self::$DEBUG) {
					$str = sprintf("[CMD %s]", self::getCmdStr($cmd));
					$str .= sprintf("[OPT %s]", self::getOptStr($opt));
					print($str . "\n");
				}
			}
			if (!$is_get_more_data) {
				$a_c = array();
				//FIXME: Do we always return to the default state? Or is it possible to negotiate in binary mode for example?
				$this->state = self::STATE_DEFAULT;
			}
		}

		return $is_get_more_data;
	}


	/**
	 * Write command to a socket
	 *
	 * @param string $buffer Stuff to write to socket
	 * @param boolean $add_newline Default true, adds newline to the command
	 * @return boolean true on success
	 * @throws ConnectionException if connection on socket errors
	 */
	protected function write($buffer, $add_newline = true) {
		if (!is_resource($this->socket)) {
			throw new ConnectionException("Telnet connection closed");
		}

		if ($add_newline) {
			$buffer .= self::NVT_CR . self::NVT_LF;
		}

		/*
		 * FIXME: This is dubious: why not rely on DO ECHO?
		 * (Admittedly the original code WONT/DONT all options and my test servers don't respect DONT ECHO)
		 */
		//FIXME: Allow toggling this
		//FIXME: This also gets a pass at the <CR> <LF> filtering, which is bad
		/* FIXME: This also doesn't respect the order of things:
		 * since we return as soon as the prompt is found (regardless of whether or not more characters have been received or not), appending to the global buffer means those characters get written after (while they were received before)
		 */
		//$this->global_buffer .= $buffer;

		$ret = fwrite($this->socket, $buffer);
		if ($ret !== strlen($buffer)) { //|| $ret === false)
			throw new ConnectionException("Error writing to socket");
		}

		return self::TELNET_OK;
	}


	public function matchesPrompt($line) {
		return preg_match("/{$this->regex_prompt}/", $line) === 1;
	}


	/**
	 * Reads socket until prompt is encountered
	 *
	 * @param boolean $do_get_remaining_data set to true to read all received data after the prompt is found
	 * @return string[] array of lines (trailing "\n" are stripped)
	 */
	protected function waitPrompt($do_get_remaining_data = false) {
		if (self::$DEBUG) {
			print("\nWaiting for prompt \"{$this->regex_prompt}\"\n");
		}

		$a_line = array();
		do {
			$line = $this->getNextLine();

			if ($line === false) {
				usleep(1);
				continue;
			} else {
				$a_line[] = rtrim($line, "\n");
			}

		} while (!$this->matchesPrompt($line));

		if ($do_get_remaining_data) {
			$line = $this->getRemainingData();
			if ($line !== false) {
				$a_line = array_merge($a_line, explode("\n", $line));
			}
		}

		return $a_line;
	}
}