franta-hg@0: #include <cstdlib>
franta-hg@0: #include <iostream>
franta-hg@0: #include <wchar.h>
franta-hg@0: #include <locale.h>
franta-hg@0: #include <cstring>
franta-hg@20: #include <unordered_map>
franta-hg@6: 
franta-hg@19: #include "types.h"
franta-hg@20: #include "memory.h"
franta-hg@20: #include "Command.h"
franta-hg@20: #include "commands/Goto.h"
franta-hg@25: #include "commands/GotoCompare.h"
franta-hg@22: #include "commands/Sleep.h"
franta-hg@23: #include "commands/End.h"
franta-hg@24: #include "commands/Color.h"
franta-hg@26: #include "commands/IncrementDecrement.h"
franta-hg@19: 
franta-hg@0: using namespace std;
franta-hg@0: 
franta-hg@12: // TODO: strong typedefs http://www.boost.org/doc/libs/1_61_0/libs/serialization/doc/strong_typedef.html ?
franta-hg@12: 
franta-hg@13: /**
franta-hg@13:  * Skip to the given address.
franta-hg@13:  * parameter: address_t
franta-hg@13:  */
franta-hg@5: const command_t CMD_GOTO = 0x70;
franta-hg@13: 
franta-hg@13: /**
franta-hg@15:  * Compare values on two addresses and go to one of given three addresses.
franta-hg@15:  * parameter: address_t a
franta-hg@15:  * parameter: address_t b
franta-hg@15:  * parameter: address_t GOTO target when a == b
franta-hg@15:  * parameter: address_t GOTO target when a > b
franta-hg@15:  * parameter: address_t GOTO target when a < b
franta-hg@15:  */
franta-hg@15: const command_t CMD_GOTO_COMPARE = 0x80;
franta-hg@15: 
franta-hg@15: /**
franta-hg@13:  * Wait given time in ms.
franta-hg@13:  * parameter: sleep_t
franta-hg@13:  */
franta-hg@5: const command_t CMD_SLEEP = 0xFF;
franta-hg@13: 
franta-hg@13: /**
franta-hg@13:  * Set RGB LED color.
franta-hg@13:  * parameter: led_t LED number
franta-hg@13:  * parameter: color_t red
franta-hg@13:  * parameter: color_t green
franta-hg@13:  * parameter: color_t blue
franta-hg@13:  */
franta-hg@10: const command_t CMD_COLOR = 0xAA;
franta-hg@13: 
franta-hg@13: /**
franta-hg@13:  * Stop program.
franta-hg@13:  */
franta-hg@5: const command_t CMD_END = 0xED;
franta-hg@13: 
franta-hg@13: /**
franta-hg@14:  * Increase value at given address
franta-hg@14:  * parameter: address_t
franta-hg@14:  */
franta-hg@14: const command_t CMD_INCREMENT = 0x11;
franta-hg@14: 
franta-hg@14: /**
franta-hg@14:  * Decrease value at given address
franta-hg@14:  * parameter: address_t
franta-hg@14:  */
franta-hg@14: const command_t CMD_DECREMENT = 0x12;
franta-hg@14: 
franta-hg@14: /**
franta-hg@13:  * Placeholder for unsupported command.
franta-hg@13:  * Just for testing.
franta-hg@13:  */
franta-hg@13: const command_t CMD_INVALID = 0x1;
franta-hg@0: 
franta-hg@15: // TODO: more commands, better numbers
franta-hg@15: 
franta-hg@0: int main(int argc, char* argv[]) {
franta-hg@0: 
franta-hg@0: 	setlocale(LC_ALL, "");
franta-hg@0: 
franta-hg@17: 	octet_t * memory = (octet_t*) malloc(MEMORY_SIZE);
franta-hg@0: 
franta-hg@16: 	// Sample program / data:
franta-hg@16: 	// TODO: load bytes from file, stdin, serial port, network…
franta-hg@2: 	{
franta-hg@2: 		address_t a = 0;
franta-hg@9: 		write<command_t>(memory, a, CMD_SLEEP);
franta-hg@9: 		write<sleep_t>(memory, a, 255);
franta-hg@9: 		write<command_t>(memory, a, CMD_SLEEP);
franta-hg@9: 		write<sleep_t>(memory, a, 10);
franta-hg@9: 		write<command_t>(memory, a, CMD_SLEEP);
franta-hg@9: 		write<sleep_t>(memory, a, 255);
franta-hg@9: 		write<command_t>(memory, a, CMD_GOTO);
franta-hg@15: 		write<address_t>(memory, a, a + sizeof (address_t) + 2 * sizeof (command_t));
franta-hg@11: 		write<command_t>(memory, a, CMD_INVALID);
franta-hg@11: 		write<command_t>(memory, a, CMD_INVALID);
franta-hg@9: 		write<command_t>(memory, a, CMD_SLEEP);
franta-hg@9: 		write<sleep_t>(memory, a, 255);
franta-hg@10: 		write<command_t>(memory, a, CMD_COLOR);
franta-hg@13: 		write<led_t>(memory, a, 23);
franta-hg@11: 		write<color_t>(memory, a, 0);
franta-hg@11: 		write<color_t>(memory, a, 200);
franta-hg@11: 		write<color_t>(memory, a, 255);
franta-hg@14: 		write<command_t>(memory, a, CMD_INCREMENT);
franta-hg@14: 		write<address_t>(memory, a, 0);
franta-hg@14: 		write<command_t>(memory, a, CMD_DECREMENT);
franta-hg@14: 		write<address_t>(memory, a, 0);
franta-hg@15: 		write<command_t>(memory, a, CMD_GOTO_COMPARE);
franta-hg@15: 		write<address_t>(memory, a, 0);
franta-hg@15: 		write<address_t>(memory, a, 0 + sizeof (command_t) + sizeof (sleep_t));
franta-hg@15: 		write<address_t>(memory, a, a - 3 * sizeof (address_t) - 2 * sizeof (command_t));
franta-hg@15: 		write<address_t>(memory, a, 0);
franta-hg@15: 		write<address_t>(memory, a, a + sizeof (address_t));
franta-hg@9: 		write<command_t>(memory, a, CMD_END);
franta-hg@2: 	}
franta-hg@0: 
franta-hg@21: 	unordered_map<command_t, shared_ptr < Command>> commands = {
franta-hg@21: 		{CMD_GOTO, make_shared<commands::Goto>()},
franta-hg@25: 		{CMD_GOTO_COMPARE, make_shared<commands::GotoCompare>()},
franta-hg@22: 		{CMD_SLEEP, make_shared<commands::Sleep>()},
franta-hg@23: 		{CMD_END, make_shared<commands::End>()},
franta-hg@24: 		{CMD_COLOR, make_shared<commands::Color>()},
franta-hg@27: 		{CMD_INCREMENT, make_shared < commands::IncrementDecrement>(true, 1)},
franta-hg@27: 		{CMD_DECREMENT, make_shared < commands::IncrementDecrement>(false, 1)},
franta-hg@21: 	};
franta-hg@27: 
franta-hg@21: 
franta-hg@2: 	for (address_t i = 0; i < MEMORY_SIZE;) {
franta-hg@11: 		wprintf(L"command %*d = ", 4, i);
franta-hg@26: 		command_t commandCode = read<command_t>(memory, i);
franta-hg@26: 		wprintf(L"%02X  ", commandCode);
franta-hg@0: 
franta-hg@26: 		shared_ptr<Command> command = commands[commandCode];
franta-hg@21: 
franta-hg@26: 		if (command) {
franta-hg@26: 			command->process(memory, i);
franta-hg@21: 		} else {
franta-hg@26: 			wprintf(L"invalid command\n");
franta-hg@21: 		}
franta-hg@0: 	}
franta-hg@0: 
franta-hg@7: 	free(memory);
franta-hg@7: 	memory = nullptr;
franta-hg@0: 	wprintf(L"all done\n");
franta-hg@0: 	return 0;
franta-hg@0: }