#!/usr/bin/env python3

import sys
import os

from PIL import Image


def main():
    if len(sys.argv) != 3:
        print("Usage: %s <image> <output file>" % sys.argv[0])
        sys.exit(-1)

    img = Image.open(sys.argv[1]).convert('RGB')

    width, height = img.size

    print("Size: %d x %d = %d bytes" % (width, height, width * height * 2))

    file_name = os.path.basename(sys.argv[2])
    include_guard =  file_name.replace('.','_').upper()
    variable_name = '_'.join(file_name.split('.')[:-1])

    output_file = open(sys.argv[2], 'w')
    output_file.write("#ifndef _%s_\n" % include_guard)
    output_file.write("#define _%s_\n" % include_guard)
    output_file.write("#include <avr/pgmspace.h>\n\n")
    output_file.write("static const uint16_t PROGMEM %s[] = {\n" % variable_name)
    output_file.write("\t0x%x, 0x%x,\n" % (width, height))

    for y in range(0, height):
        output_file.write("\t")

        for x in range(0, width):
            r, g, b = img.getpixel((x, y))

            packed_color = ((r & 0xF8) << 8) | ((g & 0xFC) << 3) | (b >> 3)
            output_file.write("0x%x, " % packed_color)

        output_file.write("\n")

    output_file.write("};\n")
    output_file.write("#endif\n")
    output_file.close()


if __name__ == '__main__':
    main()