boardd/can_recv_thread: improve caching for can_frame (#22944)

* better cache

* use emplace to remove copy&realloc

* rebase master
old-commit-hash: 841fb93def

selfdrive/boardd/boardd.cc

@@ -237,6 +237,7 @@ void can_recv_thread(std::vector<Panda *> pandas) {
   // run at 100hz
   const uint64_t dt = 10000000ULL;
   uint64_t next_frame_time = nanos_since_boot() + dt;
+  std::vector<can_frame> raw_can_data;
 
   while (!do_exit) {
     if (!check_all_connected(pandas)){
@@ -244,8 +245,8 @@ void can_recv_thread(std::vector<Panda *> pandas) {
       break;
     }
 
-    std::vector<can_frame> raw_can_data;
     bool comms_healthy = true;
+    raw_can_data.clear();
     for (const auto& panda : pandas) {
       comms_healthy &= panda->can_receive(raw_can_data);
     }

selfdrive/boardd/panda.cc

@@ -430,8 +430,6 @@ bool Panda::can_receive(std::vector<can_frame>& out_vec) {
     return false;
   }
 
-  out_vec.reserve(out_vec.size() + (recv / CANPACKET_HEAD_SIZE));
-
   static uint8_t tail[CANPACKET_MAX_SIZE];
   uint8_t tail_size = 0;
   uint8_t counter = 0;
@@ -453,9 +451,10 @@ bool Panda::can_receive(std::vector<can_frame>& out_vec) {
       uint8_t data_len = dlc_to_len[(chunk[pos] >> 4)];
       uint8_t pckt_len = CANPACKET_HEAD_SIZE + data_len;
       if (pckt_len <= (chunk_len - pos)) {
-        can_frame canData;
         can_header header;
         memcpy(&header, &chunk[pos], CANPACKET_HEAD_SIZE);
+
+        can_frame &canData = out_vec.emplace_back();
         canData.busTime = 0;
         canData.address = header.addr;
         canData.src = header.bus + bus_offset;
@@ -465,9 +464,6 @@ bool Panda::can_receive(std::vector<can_frame>& out_vec) {
         canData.dat.assign((char*)&chunk[pos+CANPACKET_HEAD_SIZE], data_len);
 
         pos += pckt_len;
-
-        // add to vector
-        out_vec.push_back(canData);
       } else {
         // Keep partial CAN packet until next USB packet
         tail_size = (chunk_len - pos);

selfdrive/boardd/tests/test_boardd

@@ -0,0 +1,3 @@
+version https://git-lfs.github.com/spec/v1
+oid sha256:b5c0b301b3fc7c0f4718409ed68033eb870f127489e9d834aa9dbd23ed7eb91b
+size 13919544