find
Finds the closest scoring position to the robot's current position. Starts by finding the closest april tag to the robot's current position. Based on the direction passed in, it returns the corresponding scoring position. Then it path finds to that position (hopefully).
Return
The command to move to the closest scoring position.
Parameters
position
The robot's current position.
direction
The direction in which to find the closest scoring position.