Finished connectiong .c and .h files
Added some printing and key movements