const pi = Math.PI;
const car = (r, theta) => vector(r*Math.cos(theta), r*Math.sin(theta));

const validCommands = {
	'GCODE': ['string', 'object'],	// insert gcode
	'PATH': ['object'],	// list of points to follow
	'GOTO': ['object'],	// go to point
	'PEN': ['string'],	// "UP" or "DOWN"
	'COMMENT': ['string'],	// add gcode comment
};

class Command {
	constructor(cmd, data, comment="") {
		let validCmd = validCommands[cmd];
		let validDta = validCmd != undefined ? validCmd.includes(typeof(data)) : undefined;
		if (!validCmd) throw(`InvalidCommand: '${cmd}'`);
		if (!validDta) throw(`InvalidArgument: Type '${typeof(data)}' for '${cmd}'`);

		this.cmd = cmd;
		this.data = data;
		this.comment = comment;
	}

	static toGcode(addSpace=false) {
		switch (this.cmd) {
			case 'GCODE':
				if (typeof(this.data) == 'string') {

				} else {

				}
			break;

			case 'PATH':
				break;

			case 'GOTO':
				break;

			case 'PEN':
				break;

			case 'COMMENT':
				break;
		}
	}

	gcode() {
		let code = this.comment != "" ? `; ${this.comment}` : '';

		switch (this.cmd) {
			case 'GCODE':
				if (typeof(this.data) == 'string') {
					code += this.data;
				} else {
					this.data.forEach((line, i) => {
						code += line;
						code += (i < this.data.length-1) ? '\n' : '';
					});
				}
			break;

			case 'PATH':
				break;

			case 'GOTO':
				break;

			case 'PEN':
				break;

			case 'COMMENT':
				break;
		}
	}
}

class Vector {
	constructor(x=0, y=0) {
		this.x = x;
		this.y = y;
	}

	add(vect) {
		this.x += vect.x;
		this.y += vect.y;
	}

	sub(vect) {
		this.x -= vect.x;
		this.y -= vect.y;
	}

	mult(scalar) {
		this.x *= scalar;
		this.y *= scalar;
	}
}

const addVect = (a, b) => ({
	'X': a.X + b.X,
	'Y': a.Y + b.Y
});








const revStr = (str) => str.split('').reverse().join('');
const formatNum = (n, sep=',') => revStr(revStr(n.toString()).match(/.{1,3}/g).join(sep));