Java port of LuNaTeCs 316 2013 robot code