Program is working. Only thing left is to handle a km/h speed limit. And cleaning up the code. And adding javadocs. There are still a few things left.