#include "commands.h"

static command_t registeredCommands[NUM_COMMANDS] = {
	{ 0x00, 0x00, stringType, "debug", 			&debug },				//DEBUG
	{ 0x01, 0x00, stringType, "setyaw", 		&setyaw },				//CALIBRATION
	{ 0x01, 0x01, stringType, "setyawp", 		&setyawp },
	{ 0x01, 0x02, stringType, "setyawd", 		&setyawd },
	{ 0x01, 0x03, stringType, "setroll", 		&setroll },
	{ 0x01, 0x04, stringType, "setrollp", 		&setrollp },
	{ 0x01, 0x05, stringType, "setrolld", 		&setrolld },
	{ 0x01, 0x06, stringType, "setpitch", 		&setpitch },
	{ 0x01, 0x07, stringType, "setpitchp",		&setpitchp },
	{ 0x01, 0x08, stringType, "setpitchd", 		&setpitchd },
	{ 0x01, 0x09, stringType, "setthrottle", 	&setthrottle },
	{ 0x01, 0x0A, stringType, "setthrottlep", 	&setthrottlep },
	{ 0x01, 0x0B, stringType, "setthrottlei", 	&setthrottlei },
	{ 0x01, 0x0C, stringType, "setthrottled", 	&setthrottled },
	{ 0x02, 0x00, stringType, "getaccel", 		&getaccel },			//REQUEST
	{ 0x02, 0x01, stringType, "getgyro", 		&getgyro },
	{ 0x02, 0x02, stringType, "getpitchangle", 	&getpitchangle },
	{ 0x02, 0x03, stringType, "getrollangle", 	&getrollangle },
	{ 0x03, 0x00, stringType, "accelresp",		accelresp },			//RESPONSE
	{ 0x03, 0x01, stringType, "gyroresp",   	&gyroresp },
	{ 0x03, 0x02, stringType, "pitchangleresp", &pitchangleresp },
	{ 0x03, 0x03, stringType, "rollangleresp", 	&rollangleresp },
	{ 0x04, 0x00, stringType, "update", 		&update },				//UPDATE
	{ 0x04, 0x01, stringType, "beginupdate", 	&beginupdate },
	{ 0x05, 0x00, stringType, "log", 			&logdata },				//LOG
	{ 0x05, 0x01, stringType, "response", 		&response },
};

int debug(unsigned char *c, int dataLen){
	return 0;
}
int setyaw(unsigned char *c, int dataLen){
	return 0;
}
int setyawp(unsigned char *c, int dataLen){
	return 0;
}
int setyawd(unsigned char *c, int dataLen){
	return 0;
}
int setroll(unsigned char *c, int dataLen){
	return 0;
}
int setrollp(unsigned char *c, int dataLen){
	return 0;
}
int setrolld(unsigned char *c, int dataLen){
	return 0;
}
int setpitch(unsigned char *c, int dataLen){
	return 0;
}
int setpitchp(unsigned char *c, int dataLen){
	return 0;
}
int setpitchd(unsigned char *c, int dataLen){
	return 0;
}
int setthrottle(unsigned char *c, int dataLen){
	return 0;
}
int setthrottlep(unsigned char *c, int dataLen){
	return 0;
}
int setthrottlei(unsigned char *c, int dataLen){
	return 0;
}
int setthrottled(unsigned char *c, int dataLen){
	return 0;
}
int getaccel(unsigned char *c, int dataLen){
	return 0;
}
int getgyro(unsigned char *c, int dataLen){
	return 0;
}
int getpitchangle(unsigned char *c, int dataLen){
	return 0;
}
int getrollangle(unsigned char *c, int dataLen){
	return 0;
}
int accelresp(unsigned char *c, int dataLen){
	return 0;
}
int gyroresp(unsigned char *c, int dataLen){
	return 0;
}
int pitchangleresp(unsigned char *c, int dataLen){
	return 0;
}
int rollangleresp(unsigned char *c, int dataLen){
	return 0;
}
int update(unsigned char *c, int dataLen){
	return 0;
}
int beginupdate(unsigned char *c, int dataLen){
	return 0;
}
int logdata(unsigned char *c, int dataLen){
	return 0;
}
int response(unsigned char *packet, int dataLen){
	return 0;
}