11M on input D by changing scoring function

main.go

@@ -132,19 +132,33 @@ func max(a, b int) int {
 	}
 }
 
+func (c *Car) CanPick(r *Ride) bool {
+	return !r.used && r.f >= c.EarliestFinish(r)
+}
+
+func (c *Car) pickClosestLate() *Ride {
+	var best *Ride
+	var dbest = 999999999
+	for _, r := range Rides {
+		if !c.CanPick(r) {
+			continue
+		}
+		d := c.distanceTo(r.a, r.b)
+		if d < dbest && d > r.s-c.Arrival {
+			best = r
+			dbest = d
+		}
+	}
+	return best
+}
+
 func Choose(c *Car) *Ride {
 	var bestRide *Ride
 	bestLenOfRide := 0
 	bestTotal := 0
 	// fmt.Printf("car %d\n", c.ID)
 	for _, r := range Rides {
-		if r.used {
-			continue
-		}
-		if r.Length() > 6000 {
-			continue
-		}
-		if r.f < c.EarliestFinish(r) {
+		if !c.CanPick(r) {
 			continue
 		}
 		// fmt.Printf("%d %d -> %d %d\n", r.a, r.b, r.x, r.y)
@@ -160,6 +174,12 @@ func Choose(c *Car) *Ride {
 	// if bestRide != nil {
 	// 	fmt.Printf("Picking %d %d -> %d %d\n", bestRide.a, bestRide.b, bestRide.x, bestRide.y)
 	// }
+	if bestRide != nil {
+		r := c.pickClosestLate()
+		if r != nil {
+			bestRide = r
+		}
+	}
 	return bestRide
 }