Subversion Repositories funbase_ip_library

/*
 * main.c
 *
 *  Created on: 22.2.2011
 *      Author: lehton87
 */
 
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <io.h>
#include <unistd.h>
 
#include "system.h"
#include "N2H_registers_and_macros.h"
#include "tut_n2h_regs.h"
 
#include "n2h_isr_fifo.h"
 
#include "support.h"
 
 
int main()
{
  int n_received = 0;
  int rx_data[20];
  int rx_amount = 8;
  int tx_amount = 8;  
  int send      = 0;
 
  int channels[8] = {0, 0, 0, 0, 0, 0, 0, 0};
 
  N2H_isr_fifo* n2h_isr_fifo = n2h_isr_fifo_create();
 
  // Init N2H interrupt
  n2h_isr_init(n2h_isr_fifo);
 
  printf("CPU2: starts\n");
 
  while(1)
    {
      if(n2h_isr_fifo_size(n2h_isr_fifo))
	{
	  N2H_isr_info* info = n2h_isr_fifo_pop(n2h_isr_fifo);
 
	  switch(info->isr_type)
	    {
	    case RX_READY:
 
	      printf("CPU2: received %ith packet to channel %i\n", 
		     ++n_received, info->rx_channel);
 
	      if(channels[info->rx_channel] == 2)
		{
		  channels[info->rx_channel] = 0;
		  break;
		}
 
	      memcpy((int*)rx_data, (int*)(N2H_REGISTERS_RX_BUFFER_START + 
					   info->rx_channel * rx_amount *
					   sizeof(int)), 
		     rx_amount*sizeof(int));
 
	      printf("CPU2: read data from channel %i : %X %X %X %X %X "
		     "%X %X %X\n", 
		     info->rx_channel, rx_data[0], rx_data[1], rx_data[2], 
		     rx_data[3], rx_data[4], rx_data[5], rx_data[6], 
		     rx_data[7]);	     
 
	      channels[info->rx_channel] = 0;
 
	      // Init rx chan half the time
	      int src = (rand() % 2 == 0) ? 0x00 : 0x10;
 
	      if(rand() % 2 == 0)
		{
		  int i = 0;
 
		  for(i = 0; i < 5; ++i)
		    {
		      if(channels[i] == 0)
			{
			  channels[i] = 1;
			  n2h_init_rx(i, 8*i*sizeof(int), 8, 0x400 + i + src);
			  break;
			}
		    }		  
		}
 
	      send++;
 
	      int fre = 0;
	      int x = 0;
	      for(; x < 8; ++x) {if(channels[x]== 0) fre++;}
	      printf("CPU2: %i to send, %i in FIFO, %i channels free\n", 
		     send, n2h_isr_fifo_size(n2h_isr_fifo), fre);
 
	      break;
 
	    case RX_UNKNOWN:
	      {
		int cha = 0;
 
		for(cha = 0; cha < 8; ++cha)
		  {
		    if(channels[cha] == 0)
		      {
			channels[cha] = (info->dst_address == 0x5FF) ? 2 : 1;
 
			printf("CPU2: received data to unconfigured "
			       "address 0x%X, assigning to channel %i\n",
		       info->dst_address, cha);
 
			if(!(0x400 <= info->dst_address && 
			     info->dst_address <= 0x5FF))
			  {
			    printf("CPU2: %i is invalid address, FAILURE\n", 
				   info->dst_address);
			  }
 
			// Initialize some channel to receive
			n2h_init_rx(cha, cha * rx_amount*sizeof(int), rx_amount,
				    info->dst_address);
 
			break;
		      }
		  }
		int fre = 0;
		int x = 0;
		for(; x < 8; ++x) {if(channels[x]== 0) fre++;}
		printf("CPU2: %i to send, %i in FIFO, %i channels free\n", 
		       send, n2h_isr_fifo_size(n2h_isr_fifo), fre);
 
	      }
	      break;
 
	      case TX_IGNORED:
	      {
		printf("CPU2: A transfer was ignored because it overlapped"
		       " previous one\n");
 
		int fre = 0;
		int x = 0;
		for(; x < 8; ++x) {if(channels[x]== 0) fre++;}
		printf("CPU2: %i to send, %i in FIFO, %i channels free\n", 
		       send, n2h_isr_fifo_size(n2h_isr_fifo), fre);
	      }
	      break;
 
	    }	    
 
	  // Free memory
	  free(info); info = NULL;
	}
      else if(send > 0 && (((IORD(N2H2_CHAN_BASE, 4) >> 16) & 0x1) == 1))
	{
	  // Sent packet to a random target's random address
	  int target_addr;
	  int tx_data[8];
	  int tx_slot = (rand() % 8);
	  int cha;
 
	  if(rand() % 2 == 0)
	    {
	      target_addr = 0x020 + tx_slot;
	    }
	  else
	    {
	      target_addr = 0x220 + tx_slot;
	    }
 
	  for(cha = 0; cha < 8; ++cha)
	    tx_data[cha] = 0x82000000 | ((cha+1) << 16) | target_addr;
 
	  memcpy((int*)(N2H_REGISTERS_TX_BUFFER_START + 
			tx_slot*tx_amount*sizeof(int)), 
		 (int*)tx_data, tx_amount*sizeof(int));
 
	  printf("CPU2: sending packet to 0x%X\n", target_addr);
 
	  n2h_send(N2H_REGISTERS_TX_BUFFER_START + 
		   tx_slot*tx_amount*sizeof(int), 
		   tx_amount, target_addr);
 
	  send--;
 
	  // Overlapping with previous one
	  if((rand() % 100) < 50)
	    {
	      n2h_send(N2H_REGISTERS_TX_BUFFER_START + 
		       tx_slot*tx_amount*sizeof(int), 
		       tx_amount, 0x1FF);
	      printf("CPU2: sending hazard packet\n");
	    }
	  int fre = 0;
	  int x = 0;
	  for(; x < 8; ++x) {if(channels[x]== 0) fre++;}
	  printf("CPU2: %i to send, %i in FIFO, %i channels free\n", 
		 send, n2h_isr_fifo_size(n2h_isr_fifo), fre);
	}
    }
 
  printf("CPU2: retires!\n");
  while(1); return 0;
}