/*
 *  Author : Sebastien Levieux
 *  Date : 13/12/2024
 */

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include "system.h"
#include "spinlock.h"

#include <inttypes.h>



/* Global variables */

spinlock_t sp1;

#define SIZE 10 

int Number_Sequence[SIZE];



rtems_task Test_task(
  rtems_task_argument argument
)
{

  uint32_t          cpu_self;

  char              *task_name;
  char              name[5];

  /* Get the task name */
  task_name = rtems_object_get_name( RTEMS_SELF, 5, name );
  if(&task_name==NULL)
  {
    locked_printf("\n**rtems_object_get_name return NULL**\n");
    exit(1);
  }


   /* Get the CPU Number */
  cpu_self = rtems_scheduler_get_processor();

  locked_printf("**Hello World!!! I am task %s and I am executing on CPU%d**\n", task_name, cpu_self);


  while(1){

    //lock_spinlock and Update Number_Sequence
    lock_spinlock(sp1);
    for(int i=0;i<SIZE;i++){
      Number_Sequence[i]++;
    }
    unlock_spinlock(sp1);
  }

  rtems_task_exit();
}


void main(void)
{
  char               task_num;

  uint32_t           cpu_self;
  uint32_t           cpu_nb;

  rtems_id           task_id;
  rtems_status_code  status;
  rtems_name         task_name;

  //Initialize the semaphore to make locked_printf
  locked_print_initialize();


  init_spinlock(&sp1);

  //Initialize Number_Sequence

  lock_spinlock(sp1); 
  for(int i=0;i<SIZE;i++){
    Number_Sequence[i] = i;
  }
  unlock_spinlock(sp1);

  
  cpu_self = rtems_scheduler_get_processor();
  locked_printf("\n**The master task running on CPU%d**\n", cpu_self);
  
  cpu_nb = rtems_scheduler_get_processor_maximum();
  locked_printf("**%d CPU available in this configuration**\n", cpu_nb);

  /* Create and start tasks for each processor */
  for (int i=0; i< rtems_scheduler_get_processor_maximum(); i++ ) {
    if ( i != cpu_self ) {
      
      task_num = '0' + i;
      task_name = rtems_build_name( 'T', task_num,' ',' ');
      if(&task_name==NULL)
      {
        locked_printf("\n**rtems_build_name return NULL**\n");
        exit(1);
      }

      status = rtems_task_create(
        task_name,
        1,
        RTEMS_MINIMUM_STACK_SIZE,
        RTEMS_DEFAULT_MODES,
        RTEMS_DEFAULT_ATTRIBUTES,
        &task_id
      );
      if(status!=RTEMS_SUCCESSFUL){
        locked_printf("\n**rtems_task_create not sucessfull**\n");
        exit(1);
      }


      status = rtems_task_start( task_id, Test_task, i+1 );
      if(status!=RTEMS_SUCCESSFUL){
        locked_printf("\n**rtems_task_start not sucessfull**\n");
        exit(1);
      }

    }
  }

  while(1){

    //lock_spinlock and display Number_Sequence
    lock_spinlock(sp1); 

    locked_printf("**Master Task : Number_Sequence = [");
    for(int i=0; i<SIZE-1;i++){
      locked_printf("%d,", Number_Sequence[i]);
    }
    locked_printf("%d]**\n", Number_Sequence[SIZE-1]);

    unlock_spinlock(sp1); 
  }
}