Some minor changes made
We change pattern recogntion to work for highly curved tracks. We did this by making sure we always have the correct z position