iris/mips/nanonote/server/usb-server.ccp

#pypp 0
// Iris: micro-kernel for a capability-based operating system.
// mips/nanonote/server/usb-server.ccp: Host-side helper for USB.
// Copyright 2009 Bas Wijnen <wijnen@debian.org>
//
// This program is free software: you can redistribute it and/or modify
// it under the terms of the GNU General Public License as published by
// the Free Software Foundation, either version 3 of the License, or
// (at your option) any later version.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
// GNU General Public License for more details.
//
// You should have received a copy of the GNU General Public License
// along with this program.  If not, see <http://www.gnu.org/licenses/>.

#include <unistd.h>
#include <usb.h>
#include <fstream>
#include <sstream>
#include <iostream>
#include <iomanip>
#include <shevek/mainloop.hh>
#include <shevek/server.hh>
#include <shevek/args.hh>

struct client

struct data:
	Glib::RefPtr <shevek::server <client, data *> > server
	usb_dev_handle *handle
	static int const boot_vendor = 0x601a
	static int const boot_product = 0x4740
	static int const run_vendor = 0xfffe
	static int const run_product = 0x0002
	static unsigned const timeout = 1000
	void boot (unsigned entry)
	data (std::string const &port):
		handle = NULL
		server = shevek::server <client, data *>::create ()
		server->data () = this
		server->open (port)

	private:
	static unsigned const STAGE1_LOAD = 0x80002000
	static unsigned const STAGE2_LOAD = 0x80000000
	static unsigned const STAGE1_ENTRY = STAGE1_LOAD
	enum requests:
		VR_GET_CPU_INFO		= 0
		VR_SET_DATA_ADDRESS	= 1
		VR_SET_DATA_LENGTH	= 2
		VR_FLUSH_CACHES		= 3
		VR_PROGRAM_START1	= 4
		VR_PROGRAM_START2	= 5
		POLL	= 10
	void request (requests num, unsigned data = 0)
	void send_file (unsigned address, unsigned size, char const *data)
	void reboot ():
		char buffer[8]
		if usb_control_msg (handle, USB_ENDPOINT_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, VR_GET_CPU_INFO, 0, 0, buffer, 8, timeout) < 0:
			std::cerr << "unable to send reboot message to device: " << usb_strerror () << std::endl
		usb_release_interface (handle, 0)
		usb_close (handle)
		handle = NULL
	void get_device (unsigned vendor, unsigned product, unsigned tries)
	void poll ()

void data::poll ():
	while true:
		char buffer[2]
		int s = usb_control_msg (handle, USB_ENDPOINT_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, POLL, 0, 0, buffer, 8, timeout)
		if s < 1 || s > 2 || buffer[0] != '#':
			std::cerr << "unable to send poll message to device: " << usb_strerror () << std::endl
			usb_release_interface (handle, 0)
			usb_close (handle)
			handle = NULL
			return
		if s != 1:
			std::cout << buffer[1] << std::flush
		else:
			break
	(shevek::absolute_time () + shevek::relative_time (1, 0)).schedule (sigc::mem_fun (*this, &data::poll))

struct client : public shevek::server <client, data *>::connection:
	static Glib::RefPtr <client> create ():
		return Glib::RefPtr <client> (new client ())
	bool keep
	void pickup (bool is_stdio):
		keep = is_stdio
	void read (std::string const &line):
		shevek::istring l (line)
		unsigned entry
		if l ("reboot %x%", entry):
			get_server ()->data ()->boot (entry)
		else if l ("shutdown%"):
			std::cerr << "shutting down\n"
			shevek::end_loop ()
		else:
			out->write ("invalid command\n")
		if !keep:
			out->write_block ()
			disconnect ()

void data::request (requests r, unsigned data):
	if usb_control_msg (handle, USB_ENDPOINT_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, r, (data >> 16) & 0xffff, data & 0xffff, NULL, 0, timeout) < 0:
		std::cerr << "unable to send control message to NanoNote: " << usb_strerror () << ".\n"
		usb_release_interface (handle, 0)
		usb_close (handle)
		handle = NULL

void data::send_file (unsigned address, unsigned size, char const *data):
	request (VR_SET_DATA_ADDRESS, address)
	char const *ptr = data
	while ptr - data < size:
		int ret = usb_bulk_write (handle, 1, ptr, size - (ptr - data), timeout)
		if ret <= 0:
			std::cerr << "failed to write to NanoNote.\n"
			usb_release_interface (handle, 0)
			usb_close (handle)
			handle = NULL
			return
		ptr += ret

void data::get_device (unsigned vendor, unsigned product, unsigned tries):
	for unsigned i = 0; i < tries; ++i:
		usb_find_busses ()
		usb_find_devices ()
		for struct usb_bus *bus = usb_busses; bus; bus = bus->next:
			for struct usb_device *dev = bus->devices; dev; dev = dev->next:
				if dev->descriptor.idProduct != product || dev->descriptor.idVendor != vendor:
					//std::cerr << shevek::ostring ("Not using %04x:%04x when looking for %04x:%04x\n", dev->descriptor.idVendor, dev->descriptor.idProduct, vendor, product)
					continue
				handle = usb_open (dev)
				if usb_claim_interface (handle, 0) < 0:
					std::cerr << "unable to claim interface: " << usb_strerror () << "\n"
					usb_close (handle)
					handle = NULL
					continue
				(shevek::absolute_time () + shevek::relative_time (1, 0)).schedule (sigc::mem_fun (*this, &data::poll))
				return
		if i + 1 < tries:
			//std::cerr << "failed to find device, still trying...\n"
			sleep (1)
	std::cerr << shevek::ostring ("giving up finding device %04x:%04x\n", vendor, product)

void data::boot (unsigned entry):
	std::cerr << "booting " << shevek::ostring ("%x", entry) << "\n"
	if handle:
		usb_release_interface (handle, 0)
		usb_close (handle)
		handle = NULL
	get_device (boot_vendor, boot_product, 1)
	if !handle:
		get_device (run_vendor, run_product, 1)
		if !handle:
			std::cerr << "unable to find device\n"
			return
		reboot ()
		get_device (boot_vendor, boot_product, 5)
		if !handle:
			std::cerr << "unable to reboot device\n"
			return
	std::cerr << "sending stage 1\n"
	std::ifstream file (STAGE1_FILE)
	std::ostringstream stage1
	stage1 << file.rdbuf ()
	send_file (STAGE1_LOAD, stage1.str ().size (), stage1.str ().data ())
	std::cerr << "running stage 1\n"
	request (VR_PROGRAM_START1, STAGE1_ENTRY)
	usleep (100)
	std::ostringstream stage2
	usb_release_interface (handle, 0)
	file.close ()
	file.open (STAGE2_FILE)
	stage2 << file.rdbuf ()
	std::cerr << "sending Iris\n"
	send_file (STAGE2_LOAD, stage2.str ().size (), stage2.str ().data ())
	std::cerr << "flushing caches\n"
	request (VR_FLUSH_CACHES)
	std::cerr << "running Iris\n"
	request (VR_PROGRAM_START2, entry)
	usb_release_interface (handle, 0)
	usb_close (handle)
	handle = NULL
	get_device (run_vendor, run_product, 5)
	if !handle:
		std::cerr << "unable to open booted device\n"
		return
	std::cerr << "(re)booted NanoNote\n"

int main (int argc, char **argv):
	usb_init ()
	std::string port ("5050")
	shevek::args::option opts[] = {
		shevek::args::option ('p', "port", "port to listen for commands", true, port)
	 }
	shevek::args args (argc, argv, opts, 0, 0, "device server for testing Iris on NanoNote", "2009")
	data d (port)
	shevek::loop ()
	return 0