Subversion Repositories Code-Repo

void UART1_WriteF(float f, unsigned char m) {

    long whole = 0;

    unsigned long decimal = 0;

    unsigned int multiplier = 1;

    unsigned char i;

    for (i = 0; i < m; i++)

        multiplier *= 10;

    whole = (long)((float)f);

    decimal = (long)((float)f*multiplier) - whole*multiplier;

    // Round up if necessary

    if ((long)((float)f*multiplier*10) % 10 >= 5)

        decimal += 1;

#ifdef _DEBUG

    sprintf((char *) uart_1_data_p->buffer_out, "%ld.%ld", whole, decimal);

    uart_1_data_p->buffer_out_len = strlen((char *) uart_1_data_p->buffer_out);

    uart_1_data_p->buffer_out_ind = 1;

    for (i = 0; i < uart_1_data_p->buffer_out_len; i++) {

        TXREG1 = uart_1_data_p->buffer_out[i];

        Nop();

        while (!PIR1bits.TX1IF); // Wait for byte to be transmitted

    }

#else

    while (TXSTA1bits.TXEN); // Wait for previous message to finish sending

    sprintf((char *) uart_1_data_p->buffer_out, "%ld.%ld", whole, decimal);

    uart_1_data_p->buffer_out_len = strlen((char *) uart_1_data_p->buffer_out);

    uart_1_data_p->buffer_out_ind = 1;

    TXREG1 = uart_1_data_p->buffer_out[0]; // Put first byte in TSR

    TXSTA1bits.TXEN = 1; // Begin transmission

#endif

}