/* Keep these headers */
#include <stdbool.h>
#include <stddef.h>
#include <stdint.h>
#include <tice.h>

/* Standard headers - it's recommended to leave them included */
#include <math.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#include "config.h"

/* Your code here */

#ifdef DEBUG
char textbuffer[11]   = {0};

/* reverse string s in place */
void reverse(char* s)
{
    uint16_t i, j;
    char c;

    for (i = 0, j = strlen(s)-1; i<j; i++, j--) {
        c = s[i];
        s[i] = s[j];
        s[j] = c;
    }
}

// Unsigned int to string (s), which also returns the pointer to the string
char* uitoa(uint32_t n, uint8_t zeropad_len)
{
    uint8_t i = 0;

    do {       /* generate digits in reverse order */
        textbuffer[i++] = n % 10 + '0';   /* get next digit */
    } while ((n /= 10) > 0);     /* delete it */

    for(; i<zeropad_len; i++)
        textbuffer[i] = '0';

    textbuffer[i] = '\0';

    reverse(textbuffer);

    return textbuffer;
}

char* itoa(int32_t n, uint8_t zeropad_len)
{
    uint8_t i = 0;
    uint8_t s = 0;
    uint32_t u = n;
    if(n<0) u=-n;
    uitoa(u,zeropad_len);
    if(n<0) {
        uint8_t l =strlen(textbuffer);
        reverse(textbuffer);
        textbuffer[l] = '-';
        textbuffer[l+1] = '\0';
        reverse(textbuffer);
    }
    return textbuffer;
}

void printTextSmall(const char *text, uint8_t xpos, uint8_t ypos) {
    os_FontDrawText(text, xpos, ypos);
}
#endif