First functional test complete and working
Add tetris_grid_print, for debug purpose