Wrote screen_write_to and screen_write functions.
Added screen_write test in main.c.