#include <SerialPort.h>

#include <stdio.h>
#include <string.h>


static int32
reader_thread(void *data)
{
	BSerialPort *port = (BSerialPort *)data;
	char buffer[128];

	while (true) {
		ssize_t read = port->Read(buffer, sizeof(buffer));
		if (read <= 0)
			continue;

		for (ssize_t i = 0; i < read; i++) {
			putc(buffer[i], stdout);
			fflush(stdout);
		}
	}

	return 0;
}


int
main(int argc, char *argv[])
{
	BSerialPort port;

	if (argc < 2) {
		printf("usage: %s <port>\n", argv[0]);

		int32 portCount = port.CountDevices();
		printf("\tports (%ld):\n", portCount);

		char nameBuffer[B_OS_NAME_LENGTH];
		for (int32 i = 0; i < portCount; i++) {
			if (port.GetDeviceName(i, nameBuffer, sizeof(nameBuffer)) != B_OK) {
				printf("\t\tfailed to retrieve name %ld\n", i);
				continue;
			}

			printf("\t\t%s\n", nameBuffer);
		}

		return 1;
	}

	status_t result = port.Open(argv[1]);
	if (result < B_OK) {
		printf("failed to open port \"%s\": %s\n", argv[1], strerror(result));
		return result;
	}

	port.SetDataRate(B_9600_BPS);
	port.SetDataBits(B_DATA_BITS_8);
	port.SetStopBits(B_STOP_BITS_1);
	port.SetParityMode(B_NO_PARITY);
	port.SetFlowControl(B_NOFLOW_CONTROL);

	thread_id reader = spawn_thread(reader_thread, "serial reader",
		B_NORMAL_PRIORITY, &port);
	if (reader < 0) {
		printf("failed to spawn reader thread\n");
		return reader;
	}

	resume_thread(reader);

	char buffer[128];
	while (true) {
		char *string = fgets(buffer, sizeof(buffer), stdin);
		if (string == NULL)
			continue;

		port.Write(buffer, strlen(string) - 1);
	}

	return 0;
}