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;

}