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

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

#include "system.h"

#include <inttypes.h>



void lock_Number_Sequence_semaphore(void){

  rtems_status_code  status;
  
  status = rtems_semaphore_obtain( Number_Sequence_semaphore, RTEMS_NO_WAIT, 0 );
  
  while (status != RTEMS_SUCCESSFUL ){
    status = rtems_semaphore_obtain( Number_Sequence_semaphore, RTEMS_NO_WAIT, 0 );
  }
}

void unlock_Number_Sequence_semaphore(void){

  rtems_semaphore_release( Number_Sequence_semaphore );
}




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 and Update Number_Sequence
    lock_Number_Sequence_semaphore();
    for(int i=0;i<SIZE;i++){
      Number_Sequence[i]++;
    }
    unlock_Number_Sequence_semaphore();
  }

  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();


  /* Create/verify synchronisation semaphore */
  status = rtems_semaphore_create(
    rtems_build_name ('S', 'E', 'M', '2'),
    1,
    RTEMS_GLOBAL           |
    RTEMS_BINARY_SEMAPHORE |
    RTEMS_FIFO,
    1,
    &Number_Sequence_semaphore
  );
  if(status!=RTEMS_SUCCESSFUL){
    locked_printf("\n**rtems_semaphore_create not sucessfull**\n");
    exit(1);
  }

  //Initialize Number_Sequence
  lock_Number_Sequence_semaphore();
  for(int i=0;i<SIZE;i++){
    Number_Sequence[i] = i;
  }
  unlock_Number_Sequence_semaphore();


  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 and display Number_Sequence
    lock_Number_Sequence_semaphore();

    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_Number_Sequence_semaphore();
  }
}