ERIKA Enterprise Forums

Code: Select all

/* called as _first_ function of a primitive that can be called in
   an IRQ and in a task */
__INLINE__ EE_FREG __ALWAYS_INLINE__ EE_hal_begin_nested_primitive(void)
{
  EE_TYPEISR2PRIO prev_prio = EE_e200zx_get_int_prio();
  EE_e200zx_set_int_prio(14U);
  return (EE_FREG)prev_prio;
}


/* Called as _last_ function of a primitive that can be called in
   an IRQ and in a task.  Enable IRQs if they were enabled before entering. */
__INLINE__ void __ALWAYS_INLINE__ EE_hal_end_nested_primitive(EE_FREG f)
{
  EE_e200zx_set_int_prio( (EE_TYPEISR2PRIO)f );
}

Code: Select all

SemType s;

/* Let's declare the tasks identifiers */
DeclareTask(Task1);
DeclareTask(Task2);
DeclareTask(Task3);

/* some other prototypes */
void mydelay(long int end);
void led_blink(unsigned char theled);

void mydelay(long int end)
{
  	volatile long int i;
  	for (i=0; i<end; i++);
  	return;  
}

void led_blink(unsigned char theled)
{
  led_status |= theled;
  EE_leds(led_status);
  mydelay((long int)300000);
  led_status &= ~theled;
  EE_leds(led_status);
}

/* Task1: just call the ChristmasTree */
TASK(Task1)
{
	while (TRUE)
	{
	  task1_fired++;

	  PostSem(&s);

	  /* First half of the christmas tree */
	  led_blink(LED_0);
	  led_blink(LED_1);
	  led_blink(LED_2);
	  led_blink(LED_3);

	  Schedule(); //TerminateTask();
	}
}

/* Task2: Print the counters on the JTAG UART */
TASK(Task2)
{
	while (TRUE)
	{
	  WaitSem(&s);

	  /* count the number of Task2 activations */
	  task2_fired++;
	}
}

/* Task3: Increment counter */
TASK(Task3)
{
	task_3++;
}

ISR2(Counter_Interrupt)
{
	STM.CNT.R = 1u;
	STM.CIR0.B.CIF = 1u;

	t_uptime++;
}

static void setup_interrupts(void)
{
  EE_e200z7_enableIRQ();
}

void STMInit(void)
{
	STM.CR.B.FRZ = 1u;
	STM.CMP0.R = 0x0001D4C0u;
	STM.CCR0.B.CEN = 1u;
	STM.CR.B.TEN = 1u;
}

/* called as _first_ function of a primitive that can be called in
   an IRQ and in a task */
EE_FREG  EE_hal_begin_nested_primitive(void)
{
	/* vnz0r */
//	return EE_hal_suspendIRQ();

	EE_TYPEISR2PRIO prev_prio = EE_e200zx_get_int_prio();
	EE_e200zx_set_int_prio(14U);
	return (EE_FREG)prev_prio;
}


/* Called as _last_ function of a primitive that can be called in
   an IRQ and in a task.  Enable IRQs if they were enabled before entering. */
void  EE_hal_end_nested_primitive(EE_FREG f)
{
//	EE_hal_resumeIRQ(f);

	EE_e200zx_set_int_prio( (EE_TYPEISR2PRIO)f );
}


int main(void)
{
  WD_DisableSoftwareWatchdog();
  PLL_InitializeModesAndClock();
  PLL_initOutputClock();

  PIT_Init();
  PIT_SetState(ePIT_3, TRUE);

  STMInit();

  /* Init devices */
  EE_buttons_init();
  
  /* Init leds */
  EE_leds_init();
  
  setup_interrupts();
  
  /* let's start the multiprogramming environment...*/
//  StartOS(OSDEFAULTAPPMODE);

  InitSem(s,0);

  ActivateTask(Task2);
  ActivateTask(Task1);

  /* now the background activities... */
  for (;;);
  
  return 0;
}

Code: Select all

SemType s;

/* Let's declare the tasks identifiers */
DeclareTask(Task1);
DeclareTask(Task2);
DeclareTask(Task3);

/* some other prototypes */
void mydelay(long int end);
void led_blink(unsigned char theled);

void mydelay(long int end)
{
     volatile long int i;
     for (i=0; i<end; i++);
     return;  
}

void led_blink(unsigned char theled)
{
  led_status |= theled;
  EE_leds(led_status);
  mydelay((long int)300000);
  led_status &= ~theled;
  EE_leds(led_status);
}

/* Task1: just call the ChristmasTree */
TASK(Task1)
{
   while (TRUE)
   {
     task1_fired++;

     /* PostSem(&s); */ /* Use ActivateTask(Task2) */

     /* First half of the christmas tree */
     led_blink(LED_0);
     led_blink(LED_1);
     led_blink(LED_2);
     led_blink(LED_3);

     /* Schedule(); //TerminateTask(); */ /* EG: If you are not using resources this is useless */
     /* EG: Add some kind of delay or, better, return and reactive it with an alarm */
   }
}

/* Task2: Print the counters on the JTAG UART */
TASK(Task2)
{
   /* EG: Use Task Activation instead */
   /* while (TRUE) {
     WaitSem(&s); */

     /* count the number of Task2 activations */
     task2_fired++;
  /* } */
}

/* Task3: Increment counter */
TASK(Task3)
{
   task_3++;
}

ISR2(Counter_Interrupt)
{
   STM.CNT.R = 1u;
   STM.CIR0.B.CIF = 1u;

   t_uptime++;
}

static void setup_interrupts(void)
{
  EE_e200z7_enableIRQ();
}

void STMInit(void)
{
   STM.CR.B.FRZ = 1u;
   STM.CMP0.R = 0x0001D4C0u;
   STM.CCR0.B.CEN = 1u;
   STM.CR.B.TEN = 1u;
}

/* EG: Did you commented the code in .../e200zx/inc/ee_internal.h? Otherwise
   the following won't be used... */

/* called as _first_ function of a primitive that can be called in
   an IRQ and in a task */
EE_FREG  EE_hal_begin_nested_primitive(void)
{
   /* vnz0r */
//   return EE_hal_suspendIRQ();

   EE_TYPEISR2PRIO prev_prio = EE_e200zx_get_int_prio();
   EE_e200zx_set_int_prio(14U);
   return (EE_FREG)prev_prio;
}


/* Called as _last_ function of a primitive that can be called in
   an IRQ and in a task.  Enable IRQs if they were enabled before entering. */
void  EE_hal_end_nested_primitive(EE_FREG f)
{
//   EE_hal_resumeIRQ(f);

   EE_e200zx_set_int_prio( (EE_TYPEISR2PRIO)f );
}


int main(void)
{
  WD_DisableSoftwareWatchdog();
  PLL_InitializeModesAndClock();
  PLL_initOutputClock();

  PIT_Init();
  PIT_SetState(ePIT_3, TRUE);

  STMInit();

  /* Init devices */
  EE_buttons_init();
  
  /* Init leds */
  EE_leds_init();
  
  setup_interrupts();
  
  /* let's start the multiprogramming environment...*/
//  StartOS(OSDEFAULTAPPMODE);

  /* InitSem(s,0); EG: Try to no use semaphores with a fixed priority scheduler
     usually are useless */

  /* ActivateTask(Task2); EG: Active it from Task1 */
  ActivateTask(Task1);

  /* now the background activities... */
  for (;;);
  
  return 0;
}

Code: Select all

EE_TID EE_std_run_task_code(EE_TID tid)
{
    /* EE_hal_enableIRQ(); EG: Removed */
    EE_e200zx_set_int_prio(0U); /* EG: added */
    EE_call_task_body(tid); /* Call the task body */
    EE_e200zx_set_int_prio(14U); /* EG: added */
    /* EE_hal_disableIRQ(); EG: removed */
    EE_thread_end_instance(); /* Call the scheduler */
    return EE_std_endcycle_next_tid;
}