Fix Debug messages

[chrishajduk84]

The original intention was to have the UART debug screen look as such:

[error]PWM interface not initialized.
[warning]Zero values for altitude measurements
[error]Divide by zero occurred.
[debug]testing123

Currently, the [error], [warning], [debug] tags do not work. The concat function in debug.c causes a chip reset.

This is not a priority, it is a minor problem.

[chrishajduk84]

Works correctly now.