Files
openvehicle-api/examples/auto_headlamp_example/autoheadlight_service/autoheadlight_cs.h
2026-03-27 14:12:49 +01:00

149 lines
5.6 KiB
C++
Raw Blame History

/********************************************************************************
* Copyright (c) 2025-2026 ZF Friedrichshafen AG
*
* This program and the accompanying materials are made available under the
* terms of the Apache License Version 2.0 which is available at
* https://www.apache.org/licenses/LICENSE-2.0
*
* SPDX-License-Identifier: Apache-2.0
********************************************************************************/
#ifndef COMPLEX_SERVICE_EXAMPLE_H
#define COMPLEX_SERVICE_EXAMPLE_H
// C++ library
#include <iostream>
// SDV framework support
#include <support/component_impl.h>
#include <support/signal_support.h>
#include <support/timer.h>
#include <support/toml.h>
// VSS interfaces - located in ../generated/vss_files/include
#include "vss_vehiclepositioncurrentlatitude_bs_rx.h"
#include "vss_vehiclepositioncurrentlongitude_bs_rx.h"
#include "vss_vehiclebodylightfrontlowbeam_bs_tx.h"
// Complex service Headlight interface - located in ../generated/example_service
#include "autoheadlight_cs_ifc.h"
/**
* @brief Auto Headlight service
* @details This complex service enables the headlight if the vehicle position is detected inside the tunnel and disables the headlight
* if vehicle is detected outside the tunnel. This also checks if the time based on summer and winter season and enables it accordingly.(time aspect will be developed later)
*
* Input events from basic service: CurrentLatitude
* CurrentLongitude
* Output calls for basic service: headlight (true or false)
*
* Input calls for applications: autoheadlight enabled (true/false)
* Output info for applications: headlight status (true/false)
* Inside the tunnel (true/false)
*/
class CAutoHeadlightService :
public sdv::CSdvObject,
public IAutoheadlightService,
public vss::Vehicle::Position::CurrentLatitudeService::IVSS_SetCurrentLatitude_Event,
public vss::Vehicle::Position::CurrentLongitudeService::IVSS_SetCurrentLongitude_Event
{
public:
/**
* @brief Constructor
*/
CAutoHeadlightService();
/**
* @brief Destructor
*/
~CAutoHeadlightService();
// Interface map
BEGIN_SDV_INTERFACE_MAP()
SDV_INTERFACE_ENTRY(vss::Vehicle::Position::CurrentLatitudeService::IVSS_SetCurrentLatitude_Event)
SDV_INTERFACE_ENTRY(vss::Vehicle::Position::CurrentLongitudeService::IVSS_SetCurrentLongitude_Event)
SDV_INTERFACE_ENTRY(IAutoheadlightService)
END_SDV_INTERFACE_MAP()
// Object declarations
DECLARE_OBJECT_CLASS_TYPE(sdv::EObjectType::vehicle_function)
DECLARE_OBJECT_CLASS_NAME("Auto Headlight Service")
DECLARE_OBJECT_SINGLETON()
// Parameter map
BEGIN_SDV_PARAM_MAP()
SDV_PARAM_ENABLE_LOCKING()
SDV_PARAM_ENTRY(m_SGPSBoundingBox.fTunnelMinLat, "tunnel_start_lat", 0.0f, u8"<EFBFBD>", "Tunnel Start Latitude")
SDV_PARAM_ENTRY(m_SGPSBoundingBox.fTunnelMinLon, "tunnel_start_lon", 0.0f, u8"<EFBFBD>", "Tunnel Start Longitude")
SDV_PARAM_ENTRY(m_SGPSBoundingBox.fTunnelMaxLat, "tunnel_end_lat", 0.0f, u8"<EFBFBD>", "Tunnel End Latitude")
SDV_PARAM_ENTRY(m_SGPSBoundingBox.fTunnelMaxLon, "tunnel_end_lon", 0.0f, u8"<EFBFBD>", "Tunnel End Longitude")
END_SDV_PARAM_MAP()
/**
* @brief Initialization event, called after object configuration was loaded. Overload of sdv::CSdvObject::OnInitialize.
* @return Returns 'true' when the initialization was successful, 'false' when not.
*/
virtual bool OnInitialize() override;
/**
* @brief Shutdown the object. Overload of sdv::CSdvObject::OnShutdown.
*/
virtual void OnShutdown() override;
private:
/**
* @brief Set Current latitude event. Overload of vss::Vehicle::Position::CurrentLatitudeService::IVSS_SetBSCurrentLatitude_Event
* @param[in] value Current latitude value in float
*/
void SetCurrentLatitude(float value) override;
/**
* @brief Set Current Longitude event. Overload of vss::Vehicle::Position::CurrentLongitudeService::IVSS_SetBSCurrentLongitude_Event
* @param[in] value Current latitude value in float
*/
void SetCurrentLongitude(float value) override;
/**
* @brief Gets status of vehicle position if it is inside tunnel or not. Overload of IAutoheadlightService::IsinTunnel.
* @return Returns true if position of vehicle is inside tunnel and false if outside.
*/
bool IsinTunnel() const override;
/**
* @brief Get status of headlights. Overload of IAutoheadlightService::GetHeadlightStatus.
* @return Returns the status of headlights (true if switched on , false if not switched on)
*/
bool GetHeadlightStatus() const override;
/**
* @brief Get the GPS bounding box
* @return Returns the bounding box structure
*/
SGPSBoundBox GetGPSBoundBox() const override;
/**
* @brief Update the headlight status based on the vehicle position with respect to tunnel.
*/
void ProcessHeadlightBasedOnEgoPosition();
/**
* @brief Load GPS bounding box from the configuration file
*/
bool LoadGPSBounds(const sdv::u8string& rssObjectConfig);
volatile float m_fCurrentLatitude = 0.0; ///< Current Latitude
volatile float m_fCurrentLongitude = 0.0; ///< Current Longitude
volatile bool m_bHeadlight = false; ///< Headlight status
SGPSBoundBox m_SGPSBoundingBox; ///< Tunnel bounding box coordinates
///< Headlight interface.
vss::Vehicle::Body::Light::Front::LowBeamService::IVSS_SetHeadLightLowBeam* m_pHeadlightSvc = nullptr;
};
DEFINE_SDV_OBJECT(CAutoHeadlightService)
#endif // !define COMPLEX_SERVICE_EXAMPLE_H