Program Listing for File location_data_handler.hpp

Return to documentation for file (/tmp/ws/src/off_highway_sensor_drivers/off_highway_premium_radar/include/off_highway_premium_radar/location_data_handler.hpp)

// Copyright 2023 Robert Bosch GmbH and its subsidiaries
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
//     http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.

#pragma once

#include <array>
#include <cstdint>
#include <vector>

#include "off_highway_premium_radar/pdu_definitions.hpp"

namespace off_highway_premium_radar
{

class LocationDataHandler
{
public:
  using LocationDataPduRaw = std::array<uint8_t, LocationDataPdu::kPduSize>;
  LocationDataHandler();

  void handle_pdu(const LocationDataPduRaw & buffer);

  bool finished();

  LocationData assemble();

  static constexpr uint8_t kMaxNumPdu{64U};
  static constexpr uint8_t kBlockCounterOffset{24U};
  static constexpr uint8_t kBlockNumberLocsOffset{35U};

private:
  int16_t block_counter{-1};
  uint16_t num_pdus{1};
  uint16_t num_locations{0};
  std::vector<LocationDataPduRaw> pdus;
};

}  // namespace off_highway_premium_radar