File content as of revision 83:0d068da1c6b7:

#include "print_data.h"

#define NUM_PRINT_INPUTS 2
DigitalOut status_2(D4);
int printing_length[NUM_PRINT_INPUTS] = {0};
int printing_counter[NUM_PRINT_INPUTS] = {0};
char print_buffer[NUM_PRINT_INPUTS][50];



void print_filter_data(Serial *pc)
{
    static int current_print_frequency = 0;
    if (printing_counter[current_print_frequency]>=printing_length[current_print_frequency])
    {
        printing_counter[current_print_frequency]= 0;
        printing_length[current_print_frequency] = 0;
        current_print_frequency++;
        if (current_print_frequency>=NUM_PRINT_INPUTS)
        {
            current_print_frequency=0;
        }
        return;
    }    
    status_2 = 1;
    //printf("Y");
    pc->printf("%c",print_buffer[current_print_frequency][printing_counter[current_print_frequency]]);
    printing_counter[current_print_frequency]++;

    status_2 = 0;
}
void set_print_buffer(float mag,float phase, int print_identifier)
{
    /*
    if(isnan(mag)||isinf(mag)||isnan(phase)||isinf(phase))
    {
        return;
    }
    */
    if (printing_counter<printing_length)
    {
        printf("PRINT OVERLOAD\n\r");
    }
    
    printing_length[print_identifier]=sprintf (print_buffer[print_identifier], "%d %E %f\n\r",print_identifier, mag, phase);
    //printing_counter[print_identifier] = 0;
    
}