Replaced code with the old GRRLIB version from late 2012.
Might or might not compile, have yet to test.