The code is for assignment 2 is done, but maybe improve on the for-loops as they suck speedwise... tey are O(scary)