Added testsuite
Added testing script
normalize_direction unfinished tests