Set linear drive goal poses against the reef

[jkleiber]

This was an idea from @aidnem to reduce lineup time that we could try if we have time somehow

[aidnem]

I think we might as well try it with the 3 we're trying to score in auto by letting it line up (score in teleop) and then writing down the poses. If it works for these poses, we can get the rest later (probably using sim/path planner mapping). Ideally we would find the poses during field calibration but that would be 2 coral station poses + 12 reef poses per side = 28 poses total, perhaps a little bit out of our time constraints lol