Lightsensor algorithm/odometer problem