// This file is a part of Framsticks SDK.  http://www.framsticks.com/
// Copyright (C) 1999-2023  Maciej Komosinski and Szymon Ulatowski.
// See LICENSE.txt for details.

// Copyright (C) 1999,2000  Adam Rotaru-Varga (adam_rotaru@yahoo.com), GNU LGPL
// Copyright (C) since 2001 Maciej Komosinski
// 2018, Grzegorz Latosinski, added development checkpoints and support for new API for neuron types

#include "f4_conv.h"
#include <common/log.h>
#include "../genooperators.h" //for GENOPER_OK constant

#ifdef DMALLOC
#include <dmalloc.h>
#endif


GenoConv_f40::GenoConv_f40()
{
	name = "Developmental encoding";
	in_format = '4';
	out_format = '0';
	mapsupport = 1;
}


SString GenoConv_f40::convert(SString &in, MultiMap *map, bool using_checkpoints)
{
	f4_Model *model = new f4_Model();
	int res = model->buildFromF4(in, using_checkpoints);
	if (res != GENOPER_OK)
	{
		delete model;
		return SString();  // oops
	}
	if (NULL != map)
		// generate to-f0 conversion map
		model->getCurrentToF0Map(*map);
	SString out = model->getF0Geno().getGenes();
	delete model;

	/* quick debugging test - print an approximate f1 conversion of every genotype converted to f0:
	GenoConv_F41_TestOnly conv41;
	SString f1 = conv41.convert(in, NULL, false);
	printf("f1 = %s\n", f1.c_str());
	*/

	return out;
}


GenoConv_F41_TestOnly::GenoConv_F41_TestOnly()
{
	name = "Only for testing, approximate f4->f1 converter";
	// Why approximate? for example, f1 does not allow to continue after branching: X(X,X)X  <-- the last X
	// Some modifier genes are also not perfectly converted.
	// And neuron properties are ignored...
	in_format = '4';
	out_format = '1';
	mapsupport = 0;
}


SString GenoConv_F41_TestOnly::convert(SString &in, MultiMap *map, bool using_checkpoints)
{
	f4_Model *model = new f4_Model();
	int res = model->buildFromF4(in, using_checkpoints);
	if (res != GENOPER_OK)
	{
		delete model;
		return SString();  // oops
	}
	SString out;
	model->toF1Geno(out);
	delete model;
	return out;
}


f4_Model::f4_Model() : Model()
{
	cells = NULL;
}

f4_Model::~f4_Model()
{
	if (cells) delete cells;
}

int f4_Model::buildFromF4(SString &geno, bool using_checkpoints)
{
	error = GENOPER_OK;
	errorpos = -1;

	// transform geno from string to nodes
	f4_Node f4rootnode;
	int res = f4_process(geno.c_str(), &f4rootnode);
	if (res || (f4rootnode.childCount() != 1)) //consider any error fatal, preventing building a model
	{
		error = GENOPER_OPFAIL;
		errorpos = res;
		return error;
	}

	// build cells, and simulate
	if (cells) delete cells;
	cells = new f4_Cells(f4rootnode.child, false);
	if (cells->getErrorCode() != GENOPER_OK)
	{
		error = cells->getErrorCode();
		errorpos = cells->getErrorPos();
		//delete cells;
		return error;
	}

	cells->simulate();
	if (cells->getErrorCode() != GENOPER_OK)
	{
		error = cells->getErrorCode();
		errorpos = cells->getErrorPos();
		return error;
	}

	// reset recursive traverse flags
	for (int i = 0; i < cells->cell_count; i++)
		cells->C[i]->recProcessedFlag = 0;

	open(using_checkpoints); // begin model build

	// process every cell
	for (int i = 0; i < cells->cell_count; i++)
	{
		int res = buildModelRec(cells->C[i]);
		if (res)
		{
			logPrintf("f4_Model", "buildFromF4", LOG_ERROR, "Error %d when building a Model", res);
			error = res;
			break;
		}
	}

	int res_close = close();
	if (res_close == 0) // invalid
	{
		logPrintf("f4_Model", "buildFromF4", LOG_ERROR, "Error %d when closing a Model", res_close);
		error = -10;
	}

	return error;
}


f4_Cell* f4_Model::getStick(f4_Cell *C)
{
	if (C->type == CELL_STICK) return C;
	if (NULL != C->dadlink)
		return getStick(C->dadlink);
	// we have no more dadlinks, find any stick
	for (int i = 0; i < cells->cell_count; i++)
		if (cells->C[i]->type == CELL_STICK)
			return cells->C[i];
	// none!
	logMessage("f4_Model", "getStick", LOG_ERROR, "Not a single stick");
	return NULL;
}


int f4_Model::buildModelRec(f4_Cell *C)
{
	int partidx;
	int j, res;
	MultiRange range;

	if (C->recProcessedFlag)
		// already processed
		return 0;

	// mark it processed
	C->recProcessedFlag = 1;

	// make sure parent is a stick
	if (NULL != C->dadlink)
		if (C->dadlink->type != CELL_STICK)
		{
			C->dadlink = getStick(C->dadlink);
		}

	// make sure its parent is processed first
	if (NULL != C->dadlink)
	{
		res = buildModelRec(C->dadlink);
		if (res) return res;
	}

	char tmpLine[100];

	range = C->genoRange;
	if (C->type == CELL_STICK)
	{
		int jj_p1_refno;  // save for later
		// first end is connected to dad, or new
		if (C->dadlink == NULL)
		{
			// new part object for firstend
			// coordinates are left to be computed by Model
			sprintf(tmpLine, "fr=%g,ing=%g,as=%g",
				/*1.0/C->P.mass,*/ C->P.friction, C->P.ingestion, C->P.assimilation
				//C->firstend.x, C->firstend.y, C->firstend.z
			);
			partidx = addFromString(PartType, tmpLine, &range);
			if (partidx < 0) return -1;
			this->checkpoint();
			jj_p1_refno = partidx;
		}
		else {
			// adjust mass/vol of first endpoint
			jj_p1_refno = C->dadlink->p2_refno;
			Part *p1 = getPart(jj_p1_refno);
			p1->mass += 1.0;
			//      p1->volume += 1.0/C->P.mass;
		}
		// new part object for lastend
		sprintf(tmpLine, "fr=%g,ing=%g,as=%g",
			//C->lastend.x, C->lastend.y, C->lastend.z
			/*"vol=" 1.0/C->P.mass,*/ C->P.friction, C->P.ingestion, C->P.assimilation
		);
		partidx = addFromString(PartType, tmpLine, &range);
		if (partidx < 0) return -2;
		C->p2_refno = partidx;

		// new joint object
		// check that the part references are valid
		int jj_p2_refno = C->p2_refno;
		if ((jj_p1_refno < 0) || (jj_p1_refno >= getPartCount())) return -11;
		if ((jj_p2_refno < 0) || (jj_p2_refno >= getPartCount())) return -12;
		sprintf(tmpLine, "p1=%d,p2=%d,dx=%g,dy=0,dz=0,rx=%g,ry=0,rz=%g"\
			",stam=%g",
			jj_p1_refno, jj_p2_refno,
			// relative position -- always (len, 0, 0), along the stick
			// this is optional!
			C->P.length,
			// relative rotation
			C->xrot, C->zrot,
			//C->P.ruch,   // rotstif
			C->P.stamina
		);
		partidx = addFromString(JointType, tmpLine, &range);
		if (partidx < 0) return -13;
		this->checkpoint();
		C->joint_refno = partidx;
	}

	if (C->type == CELL_NEURON)
	{
		const char* nclass = C->neuclass->name.c_str();
		int partno, jointno;
		if (C->neuclass->getPreferredLocation() == 0)
		{
			if (strcmp(nclass, "N") == 0)
			{
				partno = C->dadlink->p2_refno;
				if ((partno < 0) || (partno >= getPartCount())) return -21;
				else sprintf(tmpLine, "p=%d,d=\"N:in=%g,fo=%g,si=%g\"", partno, C->inertia, C->force, C->sigmo);
			}
			else
			{
				sprintf(tmpLine, "d=\"%s\"", nclass);
			}
			partidx = addFromString(NeuronType, tmpLine, &range);
			if (partidx < 0) return -22;
			this->checkpoint();
			C->neuro_refno = partidx;
		}
		else if (C->neuclass->getPreferredLocation() == 1) // attached to Part or have no required attachment - also part
		{
			partno = C->dadlink->p2_refno;
			if ((partno < 0) || (partno >= getPartCount())) return -21;

			if (strcmp(nclass, "N") == 0)
				sprintf(tmpLine, "p=%d,d=\"N:in=%g,fo=%g,si=%g\"", partno, C->inertia, C->force, C->sigmo);
			else
				sprintf(tmpLine, "p=%d,d=\"%s\"", partno, nclass);

			partidx = addFromString(NeuronType, tmpLine, &range);
			if (partidx < 0) return -22;
			this->checkpoint();
			C->neuro_refno = partidx;
		}
		else // attached to Joint, assume there are only three possibilities of getPreferredLocation()
		{
			jointno = C->dadlink->joint_refno;

			if (strcmp(nclass, "@") == 0)
				sprintf(tmpLine, "j=%d,d=\"@:p=%g\"", jointno, C->P.muscle_power);
			else if (strcmp(nclass, "|") == 0)
				sprintf(tmpLine, "j=%d,d=\"|:p=%g,r=%g\"", jointno, C->P.muscle_power, C->mz);
			else
				sprintf(tmpLine, "j=%d,d=\"%s\"", jointno, nclass);

			partidx = addFromString(NeuronType, tmpLine, &range);
			if (partidx < 0) return -32;
			this->checkpoint();
		}
		C->neuro_refno = partidx;
		int n_refno = C->neuro_refno;

		for (j = 0; j < C->conns_count; j++)
		{
			if (C->conns[j]->from != NULL)
				buildModelRec(C->conns[j]->from);

			tmpLine[0] = 0;
			if (C->conns[j]->from == NULL)
			{
				logMessage("f4_Model", "buildModelRec", LOG_ERROR, "Old code for sensors as inputs embedded in [connection]: C->conns[j]->from == NULL");
			}
			int from = -1;
			if (C->conns[j]->from != NULL) // input from another neuron
				from = C->conns[j]->from->neuro_refno;
			if (from >= 0)
			{
				sprintf(tmpLine, "%d,%d,%g", n_refno, from, C->conns[j]->weight);
				if (addFromString(NeuronConnectionType, tmpLine, &range) < 0) return -35;
				this->checkpoint();
			}
		}
	}
	return 0;
}


void f4_Model::toF1Geno(SString &out)
{
	cells->toF1Geno(out);
}