stmbl/src/hal_term.c

#include <stdio.h>
#include "hal_term.h"
#include "main.h" // for Wait

void hal_term_print_pin(hal_pin_t* pin){
   if(pin == pin->source){//if pin is not linked
      printf("%s = %f\n", pin->name, pin->source->source->value);
   }else{//pin is linked
      printf("%s <= %s = %f\n", pin->name, pin->source->name, pin->source->source->value);
   }
}

void hal_term_list(){
   for(int i = 0; i < hal.hal_pin_count; i++){
      printf("%s <= %s = %f\n", hal.hal_pins[i]->name, hal.hal_pins[i]->source->name, hal.hal_pins[i]->source->source->value);
      Wait(1);//TODO: remove wait...
   }
}

void hal_term_getconf(){
   for(int i = 0; i < hal.hal_pin_count; i++){
      char name[6];
      strncpy(name,hal.hal_pins[i]->name,5);
      name[5] =  '\0';
      if(!strcmp(name, "conf0")){
         printf("%s = %f\n", hal.hal_pins[i]->name, hal.hal_pins[i]->value);
      }
   }
}

void hal_term_print_state(){
   switch(hal.hal_state){
      case HAL_OK:
      printf("HAL state:  HAL_OK\n");
      break;
      case RT_TOO_LONG:
      printf("HAL state:  RT_TOO_LONG\n");
      break;
      case FRT_TOO_LONG:
      printf("HAL state:  FRT_TOO_LONG\n");
      break;
      case MISC_ERROR:
      printf("HAL state:  MISC_ERROR\n");
      break;
      case MEM_ERROR:
      printf("HAL state:  MEM_ERROR\n");
      break;
      case CONFIG_LOAD_ERROR:
      printf("HAL state:  CONFIG_LOAD_ERROR\n");
      break;
      case CONFIG_ERROR:
      printf("HAL state:  CONFIG_ERROR\n");
      break;
   }
}

void hal_term_print_info(){
   printf("######## hal info ########\n");
   printf("#pins %i\n", hal.hal_pin_count);
   printf("#comps %i\n", hal.comp_count);
   printf("link errors %lu\n", hal.link_errors);
   printf("pin errors %lu\n", hal.pin_errors);
   printf("comp errors %lu\n", hal.comp_errors);
   printf("set errors %lu\n", hal.set_errors);
   printf("get errors %lu\n", hal.get_errors);
   printf("foo0.bar:  %f\n", hal_get_pin("foo0.bar"));
   printf("error_name: %s\n",hal.error_name);
   float pe = hal_get_pin("net0.rt_period");
   float ct = hal_get_pin("net0.rt_calc_time");
   if(pe > 0.0){
      printf("rt time: %f/%fs", ct, pe);
      printf("=%f%%\n",(ct/pe)*100);
   }
   pe = hal_get_pin("net0.frt_period");
   ct = hal_get_pin("net0.frt_calc_time");
   if(pe > 0.0){
      printf("frt time: %f/%fs", ct, pe);
      printf("=%f%%\n",(ct/pe)*100);
   }
   pe = hal_get_pin("net0.nrt_period");
   ct = hal_get_pin("net0.nrt_calc_time");
   if(pe > 0.0){
      printf("nrt time: %f/%fs", ct, pe);
      printf("=%f%%\n",(ct/pe)*100);
   }
   switch(hal.rt_state){
      case RT_STOP:
      printf("rt state:  STOP\n");
      break;
      case RT_SLEEP:
      printf("rt state:  SLEEP\n");
      break;
      case RT_CALC:
      printf("rt state:  CALC\n");
      break;
   }
   switch(hal.frt_state){
      case FRT_STOP:
      printf("frt state:  STOP\n");
      break;
      case FRT_SLEEP:
      printf("frt state:  SLEEP\n");
      break;
      case FRT_CALC:
      printf("frt state:  CALC\n");
      break;
   }
   hal_term_print_state();
   uint32_t p = 0;
   printf("active rt funcs(%u):\n", hal.rt_func_count);
   for(int i = 0; i < hal.rt_func_count; i++){
      p = (uint32_t)hal.rt[i];
      for(int i = 0; i < hal.comp_count; i++){
         if(p == (uint32_t)hal.hal_comps[i]->rt){
            printf("   %s%lu.rt(%f)\n", hal.hal_comps[i]->name, hal.hal_comps[i]->instance,  hal.hal_pins[hal.hal_comps[i]->hal_pin_start_index + 2]->source->source->value);
            break;
         }
      }
   }
   printf("\nactive frt funcs(%u):\n", hal.frt_func_count);
   for(int i = 0; i < hal.frt_func_count; i++){
      p = (uint32_t)hal.frt[i];
      for(int i = 0; i < hal.comp_count; i++){
         if(p == (uint32_t)hal.hal_comps[i]->frt){
            printf("   %s%lu.frt(%f)\n", hal.hal_comps[i]->name, hal.hal_comps[i]->instance, hal.hal_pins[hal.hal_comps[i]->hal_pin_start_index + 3]->source->source->value);
            break;
         }
      }
   }
   printf("\nactive rt_init funcs(%u):\n", hal.rt_init_func_count);
   for(int i = 0; i < hal.rt_init_func_count; i++){
      p = (uint32_t)hal.rt_init[i];
      for(int i = 0; i < hal.comp_count; i++){
         if(p == (uint32_t)hal.hal_comps[i]->rt_init){
            printf("   %s%lu.rt_init\n", hal.hal_comps[i]->name, hal.hal_comps[i]->instance);
            break;
         }
      }
   }
   printf("\nactive rt_deinit funcs(%u):\n", hal.rt_deinit_func_count);
   for(int i = 0; i < hal.rt_deinit_func_count; i++){
      p = (uint32_t)hal.rt_deinit[i];
      for(int i = 0; i < hal.comp_count; i++){
         if(p == (uint32_t)hal.hal_comps[i]->rt_deinit){
            printf("   %s%lu.rt_deinit\n", hal.hal_comps[i]->name, hal.hal_comps[i]->instance);
            break;
         }
      }
   }
   printf("\nactive nrt_init funcs(%u):\n", hal.nrt_init_func_count);
   for(int i = 0; i < hal.nrt_init_func_count; i++){
      p = (uint32_t)hal.nrt_init[i];
      for(int i = 0; i < hal.comp_count; i++){
         if(p == (uint32_t)hal.hal_comps[i]->nrt_init){
            printf("   %s%lu.nrt_init\n", hal.hal_comps[i]->name, hal.hal_comps[i]->instance);
            break;
         }
      }
   }
   printf("\nactive nrt funcs(%u):\n", hal.nrt_func_count);
   for(int i = 0; i < hal.nrt_func_count; i++){
      p = (uint32_t)hal.nrt[i];
      for(int i = 0; i < hal.comp_count; i++){
         if(p == (uint32_t)hal.hal_comps[i]->nrt){
            printf("   %s%lu.nrt\n", hal.hal_comps[i]->name, hal.hal_comps[i]->instance);
            break;
         }
      }
   }
   printf("\n");
}