Add Intake and Drivetrain Wpilib

Signed-off-by: Niko Sohmers <nikolai@sohmers.com>
Change-Id: Ie985062d67da657652fcab87a433ff1529f11d34
diff --git a/frc971/wpilib/generic_can_writer.h b/frc971/wpilib/generic_can_writer.h
index f317b59..7d6dd1a 100644
--- a/frc971/wpilib/generic_can_writer.h
+++ b/frc971/wpilib/generic_can_writer.h
@@ -15,9 +15,9 @@
  public:
   GenericCANWriter(
       ::aos::EventLoop *event_loop,
-      std::function<void(
-          const T &output,
-          std::map<std::string_view, std::shared_ptr<TalonFX>> talonfx_map)>
+      std::function<void(const T &output,
+                         const std::map<std::string_view,
+                                        std::shared_ptr<TalonFX>> &talonfx_map)>
           write_callback)
       : LoopOutputHandler<T>(event_loop, "/superstructure"),
         write_callback_(write_callback) {
@@ -66,9 +66,9 @@
 
   std::function<void(
       const T &output,
-      std::map<std::string_view, std::shared_ptr<TalonFX>> talonfx_map)>
+      const std::map<std::string_view, std::shared_ptr<TalonFX>> &talonfx_map)>
       write_callback_;
 };
 
 }  // namespace wpilib
-}  // namespace frc971
+}  // namespace frc971
\ No newline at end of file