/*
Bullet Continuous Collision Detection and Physics Library
Copyright (c) 2003-2007 Erwin Coumans  http://bulletphysics.com

This software is provided 'as-is', without any express or implied warranty.
In no event will the authors be held liable for any damages arising from the use of this software.
Permission is granted to anyone to use this software for any purpose, 
including commercial applications, and to alter it and redistribute it freely, 
subject to the following restrictions:

1. The origin of this software must not be misrepresented; you must not claim that you wrote the original software. If you use this software in a product, an acknowledgment in the product documentation would be appreciated but is not required.
2. Altered source versions must be plainly marked as such, and must not be misrepresented as being the original software.
3. This notice may not be removed or altered from any source distribution.
*/


//#define DEBUG_SPU_TASK_SCHEDULING 1


//class OptimizedBvhNode;

#include "SpuCollisionTaskProcess.h"






SpuCollisionTaskProcess::SpuCollisionTaskProcess(class	btThreadSupportInterface*	threadInterface, unsigned int	maxNumOutstandingTasks)
:m_threadInterface(threadInterface),
m_maxNumOutstandingTasks(maxNumOutstandingTasks)
{
	m_workUnitTaskBuffers = (unsigned char *)0;
	m_taskBusy.resize(m_maxNumOutstandingTasks);
	m_spuGatherTaskDesc.resize(m_maxNumOutstandingTasks);

	for (int i = 0; i < m_maxNumOutstandingTasks; i++)
	{
		m_taskBusy[i] = false;
	}
	m_numBusyTasks = 0;
	m_currentTask = 0;
	m_currentPage = 0;
	m_currentPageEntry = 0;

#ifdef DEBUG_SpuCollisionTaskProcess
	m_initialized = false;
#endif

	m_threadInterface->startSPU();

	//printf("sizeof vec_float4: %d\n", sizeof(vec_float4));
	printf("sizeof SpuGatherAndProcessWorkUnitInput: %d\n", sizeof(SpuGatherAndProcessWorkUnitInput));

}

SpuCollisionTaskProcess::~SpuCollisionTaskProcess()
{
	
	if (m_workUnitTaskBuffers != 0)
	{
		btAlignedFree(m_workUnitTaskBuffers);
		m_workUnitTaskBuffers = 0;
	}
	


	m_threadInterface->stopSPU();
	
}



void SpuCollisionTaskProcess::initialize2()
{

#ifdef DEBUG_SPU_TASK_SCHEDULING
	printf("SpuCollisionTaskProcess::initialize()\n");
#endif //DEBUG_SPU_TASK_SCHEDULING
	if (!m_workUnitTaskBuffers)
	{
		m_workUnitTaskBuffers = (unsigned char *)btAlignedAlloc(MIDPHASE_WORKUNIT_TASK_SIZE*m_maxNumOutstandingTasks, 128);
	}

	for (int i = 0; i < m_maxNumOutstandingTasks; i++)
	{
		m_taskBusy[i] = false;
	}
	m_numBusyTasks = 0;
	m_currentTask = 0;
	m_currentPage = 0;
	m_currentPageEntry = 0;

#ifdef DEBUG_SpuCollisionTaskProcess
	m_initialized = true;
	assert(MIDPHASE_NUM_WORKUNITS_PER_TASK*sizeof(SpuGatherAndProcessWorkUnitInput) <= MIDPHASE_WORKUNIT_TASK_SIZE);
#endif
}


void SpuCollisionTaskProcess::issueTask2()
{

#ifdef DEBUG_SPU_TASK_SCHEDULING
	printf("SpuCollisionTaskProcess::issueTask (m_currentTask= %d\n)", m_currentTask);
#endif //DEBUG_SPU_TASK_SCHEDULING

	m_taskBusy[m_currentTask] = true;
	m_numBusyTasks++;


	SpuGatherAndProcessPairsTaskDesc& taskDesc = m_spuGatherTaskDesc[m_currentTask];
	{
		// send task description in event message
		// no error checking here...
		// but, currently, event queue can be no larger than NUM_WORKUNIT_TASKS.
	
		taskDesc.inPtr = reinterpret_cast<uint64_t>(MIDPHASE_TASK_PTR(m_currentTask));
	
		taskDesc.taskId = m_currentTask;
		taskDesc.numPages = m_currentPage+1;
		taskDesc.numOnLastPage = m_currentPageEntry;
	}



	m_threadInterface->sendRequest(CMD_GATHER_AND_PROCESS_PAIRLIST, (uint32_t) &taskDesc,m_currentTask);

	// if all tasks busy, wait for spu event to clear the task.
	

	if (m_numBusyTasks >= m_maxNumOutstandingTasks)
	{
		unsigned int taskId;
		unsigned int outputSize;

		
		for (int i=0;i<m_maxNumOutstandingTasks;i++)
		  {
			  if (m_taskBusy[i])
			  {
				  taskId = i;
				  break;
			  }
		  }

	  btAssert(taskId>=0);

	  
		m_threadInterface->waitForResponse(&taskId, &outputSize);

//		printf("issueTask taskId %d completed, numBusy=%d\n",taskId,m_numBusyTasks);

		//printf("PPU: after issue, received event: %u %d\n", taskId, outputSize);

		//postProcess(taskId, outputSize);

		m_taskBusy[taskId] = false;

		m_numBusyTasks--;
	}
	
}

void SpuCollisionTaskProcess::addWorkToTask(void* pairArrayPtr,int startIndex,int endIndex)
{
#ifdef DEBUG_SPU_TASK_SCHEDULING
	printf("#");
#endif //DEBUG_SPU_TASK_SCHEDULING
	
#ifdef DEBUG_SpuCollisionTaskProcess
	assert(m_initialized);
	assert(m_workUnitTaskBuffers);

#endif

	bool batch = true;

	if (batch)
	{
		if (m_currentPageEntry == MIDPHASE_NUM_WORKUNITS_PER_PAGE)
		{
			if (m_currentPage == MIDPHASE_NUM_WORKUNIT_PAGES-1)
			{
				// task buffer is full, issue current task.
				// if all task buffers busy, this waits until SPU is done.
				issueTask2();

				// find new task buffer
				for (unsigned int i = 0; i < m_maxNumOutstandingTasks; i++)
				{
					if (!m_taskBusy[i])
					{
						m_currentTask = i;
						//init the task data

						break;
					}
				}

				m_currentPage = 0;
			}
			else
			{
				m_currentPage++;
			}

			m_currentPageEntry = 0;
		}
	}

	{



		SpuGatherAndProcessWorkUnitInput &wuInput = 
			*(reinterpret_cast<SpuGatherAndProcessWorkUnitInput*>
			(MIDPHASE_ENTRY_PTR(m_currentTask, m_currentPage, m_currentPageEntry)));
		
		wuInput.m_pairArrayPtr = reinterpret_cast<uint64_t>(pairArrayPtr);
		wuInput.m_startIndex = startIndex;
		wuInput.m_endIndex = endIndex;

		
	
		m_currentPageEntry++;

		if (!batch)
		{
			issueTask2();

			// find new task buffer
			for (unsigned int i = 0; i < m_maxNumOutstandingTasks; i++)
			{
				if (!m_taskBusy[i])
				{
					m_currentTask = i;
					//init the task data

					break;
				}
			}

			m_currentPage = 0;
			m_currentPageEntry =0;
		}
	}
}


void 
SpuCollisionTaskProcess::flush2()
{
#ifdef DEBUG_SPU_TASK_SCHEDULING
	printf("\nSpuCollisionTaskProcess::flush()\n");
#endif //DEBUG_SPU_TASK_SCHEDULING
	
	// if there's a partially filled task buffer, submit that task
	if (m_currentPage > 0 || m_currentPageEntry > 0)
	{
		issueTask2();
	}


	// all tasks are issued, wait for all tasks to be complete
	while(m_numBusyTasks > 0)
	{
	  // Consolidating SPU code
	  unsigned int taskId=-1;
	  unsigned int outputSize;
	  
	  for (int i=0;i<m_maxNumOutstandingTasks;i++)
	  {
		  if (m_taskBusy[i])
		  {
			  taskId = i;
			  break;
		  }
	  }

	  btAssert(taskId>=0);

	
	  {
			
		// SPURS support.
		  m_threadInterface->waitForResponse(&taskId, &outputSize);
	  }
//		 printf("flush2 taskId %d completed, numBusy =%d \n",taskId,m_numBusyTasks);
		//printf("PPU: flushing, received event: %u %d\n", taskId, outputSize);

		//postProcess(taskId, outputSize);

		m_taskBusy[taskId] = false;

		m_numBusyTasks--;
	}


}
