Subversion Repositories funbase_ip_library

/*
 * file   main.c
 * date   2012-02-21
 * author Lasse Lehtonen
 *      
 */
 
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/alt_irq.h>
 
 
#include "hpd_functions.h"
 
 
void my_hpd_isr();
void my_hpd_isr_init();
 
int main()
{
  printf("CPU1: starts\n");
 
  hpd_initialize();
  hpd_rx_packet_reinit(3);
  my_hpd_isr_init();  
 
  //printf("CPU1: retires!\n");
  while(1); return 0;
}
 
 
 
void my_hpd_isr()
{
  // This pe gets data only on packet channel 3.
  // Omitting others.
  char data[17]; data[16] = 0;
  if(hpd_rx_packet_poll(3)) {
    hpd_rx_packet_read(3, data);    
    printf("CPU1: \"%s\"\n", data);
    hpd_tx_send_copy((int)data, 4, 0x406);
    hpd_irq_packet_ack(3);
    hpd_rx_packet_reinit(3);
  } else {
    printf("CPU1: got unexpected interrupt!\n");
  }
}
 
 
void my_hpd_isr_init()
{
  int status;
 
  status = alt_ic_isr_register(HIBI_PE_DMA_1_IRQ_INTERRUPT_CONTROLLER_ID,
			       HIBI_PE_DMA_1_IRQ, my_hpd_isr, 
			       0, 0);
 
  if(status) {
    printf("CPU1: registering my_hpd_isr failed!\n");
  }
 
  status = alt_ic_irq_enable(HIBI_PE_DMA_1_IRQ_INTERRUPT_CONTROLLER_ID,
			     HIBI_PE_DMA_1_IRQ);
 
  if(status) {
    printf("CPU1: enabling hpd interrupt failed!\n");
  }
 
  hpd_irq_enable();
}