Updated sktrack_goal 2 added corner detection, untested