Lap counting almost working