/* 
 * Copyright 2010 Stefan Lankes, Chair for Operating Systems,
 *                               RWTH Aachen University
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *
 * This file is part of MetalSVM. 
 */

#include <metalsvm/stddef.h>
#include <metalsvm/stdio.h>
#include <metalsvm/time.h>
#include <metalsvm/tasks.h>
#include <metalsvm/semaphore.h>
#include <metalsvm/mailbox.h>
#include <metalsvm/syscall.h>
#ifdef CONFIG_ROCKCREEK
#include <asm/icc.h>
#include <asm/RCCE.h>
#include <asm/RCCE_lib.h>
#include <asm/iRCCE.h>
#include <asm/iRCCE_lib.h>

#include <asm/SCC_API.h>
#include <lwip/sockets.h>
#endif

static sem_t 		consuming, producing;
static mailbox_int32_t	mbox;
static int 		val = 0;

static int consumer(void* arg)
{
	int 	i, m = 0;

	for(i=0; i<5; i++) {
		sem_wait(&consuming);
                kprintf("Consumer got %d\n", val);
                val = 0;
                sem_post(&producing);
        }

	for(i=0; i<5; i++) {
		mailbox_int32_fetch(&mbox, &m);
		kprintf("Got mail %d\n", m);
	}

	return 0;
}

static int producer(void* arg)
{
	int 	i;
	int 	mail[5] = {1, 2, 3, 4, 5};

	for(i=0; i<5; i++) {
		sem_wait(&producing);
		kprintf("Produce value: current val %d\n", val);
		val = 42;
		sem_post(&consuming);
	}

	for(i=0; i<5; i++) {
		//kprintf("Send mail %d\n", mail[i]);
		mailbox_int32_post(&mbox, mail[i]);
	}

	return 0;
}

static int foo(void* arg)
{
	int i;

	if (!arg)
		return 0;

	for(i=0; i<5; i++) {
		kprintf("Message from core %d: %s\n", smp_id(), (char*) arg);
		sleep(1);
	}

	return 42;
}

#ifdef CONFIG_ROCKCREEK
int mail_ping(void* arg) {
	int i;

	for(i=0; i<20; i++) {
		if (BUILTIN_EXPECT(icc_mail_ping(), 0))
			return -1;        
		udelay(500000);
	}

	return 0;
}
#endif

static int join_test(void* arg)
{
	tid_t 	id, ret;
	int 	result = -1234;

	create_kernel_task(&id, foo, "Hello from foo2");

	kprintf("Wait for child %u\n", id);
	do {
		ret = wait(&result);
	} while(ret != id);

	kprintf("Child %u finished: result = %d\n", id, result);

	dump_scheduling_statistics();

	return 0;
}

#if defined(CONFIG_LWIP) && defined(CONFIG_ROCKCREEK)
static int server_task(void* e)
{
	int sockfd, newsockfd, portno, clilen;
	char buffer[256];
	struct sockaddr_in serv_addr, cli_addr;
	int  n;

	/* First call to socket() function */
	sockfd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);
	if (sockfd < 0) 
	{
		kprintf("ERROR opening socket");
		return -1;
	}
	/* Initialize socket structure */
	 memset((char *) &serv_addr,0, sizeof(serv_addr));
	portno = 5001;
	serv_addr.sin_family = AF_INET;
	serv_addr.sin_addr.s_addr = INADDR_ANY;
	serv_addr.sin_port = htons(portno);
 
	kprintf("binding");
	/* Now bind the host address using bind() call.*/
	if (bind(sockfd, (struct sockaddr *) &serv_addr,
			 sizeof(serv_addr)) < 0)
	{
		kprintf("ERROR on binding");
		return -1;
	}

	/* Now start listening for the clients, here process will
	 * go in sleep mode and will wait for the incoming connection
	 */
	kprintf("listening");
	listen(sockfd,5);
	clilen = sizeof(cli_addr);

	/* Accept actual connection from the client */
	kprintf("accepting");
	newsockfd = accept(sockfd, (struct sockaddr *)&cli_addr,  &clilen);
	if (newsockfd < 0) 
	{
		kprintf("ERROR on accept");
		return -1;
	}
	/* If connection is established then start communicating */
	memset(buffer,0,256);
	kprintf("recieving");
	n = read( newsockfd,buffer, 255);
	if (n < 0)
	{
		kprintf("ERROR reading from socket");
		return -1;
	}
	kprintf("Here is the message: %s\n",buffer);

	/* Write a response to the client */
	kprintf("writing");
	n = write(newsockfd,"I got your message",18);
	if (n < 0)
	{
		kprintf("ERROR writing to socket");
		return -1;
	}

	return 0; 
}

static int client_task(void* e)
{
	char    dir[256];
	int	sd;
	struct sockaddr_in pin;

	sleep(1);

	/* fill in the socket structure with host information */
	memset(&pin, 0, sizeof(pin));
	pin.sin_family = AF_INET;
	pin.sin_addr.s_addr = inet_addr("192.168.0.1");
	pin.sin_port = htons(5001);

	/* grab an Internet domain socket */
	if ((sd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP)) == -1) {
		kprintf("socketfail");
		return -1;
	}

	kprintf("connecting with socket nr : %d",sd);
	/* connect to PORT on HOST */

	if (connect(sd,(struct sockaddr *)  &pin, sizeof(pin)) == -1) {
		kprintf("connectfail");
		return -1;
	}
	kprintf("sending");
	/* send a message to the server PORT on machine HOST */
	if (send(sd, "HELLO THERE", strlen("HELLO THERE"), 0) == -1) {
		kprintf("sendfail");
		return -1;
	}
	kprintf("recieving");
        /* wait for a message to come back from the server */
        if (recv(sd, dir, 256, 0) == -1) {
                kprintf("recvfail");
                return -1;
        }

        /* spew-out the results and bail out of here! */
        kprintf("%s\n", dir);

	close(sd);

	return 0;
}
#endif

int test_init(void)
{
	char* argv[] = {"/bin/tests", NULL};

	sem_init(&producing, 1);
	sem_init(&consuming, 0);
	mailbox_int32_init(&mbox);

#if 0 //defined(CONFIG_LWIP) && defined(CONFIG_ROCKCREEK)
	if (!RCCE_ue())
		create_kernel_task(NULL,server_task,NULL);
	else
		create_kernel_task(NULL,client_task,NULL);
#endif

	create_kernel_task(NULL, foo, "Hello from foo1");
	create_kernel_task(NULL, join_test, NULL);
	//create_kernel_task(NULL, producer, NULL);
	//create_kernel_task(NULL, consumer, NULL);
	//create_kernel_task(NULL, mail_ping, NULL);
	//create_user_task(NULL, "/bin/hello", argv);
	create_user_task(NULL, "/bin/tests", argv);
	//create_user_task(NULL, "/bin/jacobi", argv);
	//create_user_task(NULL, "/bin/jacobi", argv);

	return 0;
}