ros2/openvehicle-api
3
0
Fork 0
mirror of https://github.com/eclipse-openvehicle-api/openvehicle-api.git synced 2026-07-02 05:35:11 +00:00
Code Issues Packages Projects Releases 1 Wiki Activity

Update sdv_packager (#6)

Browse Source
This commit is contained in:
tompzf
2026-03-27 14:12:49 +01:00
committed by GitHub
parent 234be8917f
commit aefefd52f7
717 changed files with 42252 additions and 11334 deletions
Download Patch File Download Diff File Expand all files Collapse all files

112
examples/auto_headlamp_example/autoheadlight_service/autoheadlight_cs.cpp
View File

@@ -1,27 +1,31 @@
/********************************************************************************
* 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
********************************************************************************/
#include <iostream>
#include "autoheadlight_cs.h"
CAutoHeadlightService::CAutoHeadlightService()
{
}
{}
CAutoHeadlightService::~CAutoHeadlightService()
{
Shutdown();
}
{}
void CAutoHeadlightService::Initialize(const sdv::u8string& ssObjectConfig)
bool CAutoHeadlightService::OnInitialize()
{
m_eStatus = sdv::EObjectStatus::initializing;
// Request the basic service for the headlight.
m_pHeadlightSvc = sdv::core::GetObject("Vehicle.Body.Light.Front.LowBeam_Service").GetInterface<vss::Vehicle::Body::Light::Front::LowBeamService::IVSS_SetHeadLightLowBeam>();
if (!m_pHeadlightSvc)
{
SDV_LOG_ERROR("Could not get interface 'IVSS_SetHeadlightLowBeam': [CAutoHeadlightService]");
m_eStatus = sdv::EObjectStatus::initialization_failure;
return;
return false;
}
// Request the basic service for the steering wheel.
@@ -29,8 +33,7 @@ void CAutoHeadlightService::Initialize(const sdv::u8string& ssObjectConfig)
if (!pCurrentLatitudeSvc)
{
SDV_LOG_ERROR("Could not get interface 'IVSS_GetCurrentLatitude': [CAutoHeadlightService]");
m_eStatus = sdv::EObjectStatus::initialization_failure;
return;
return false;
}
// Request the basic service for the vehicle speed.
@@ -38,8 +41,7 @@ void CAutoHeadlightService::Initialize(const sdv::u8string& ssObjectConfig)
if (!pCurrentLongitudeSvc)
{
SDV_LOG_ERROR("Could not get interface 'IVSS_GetCurrentLongitude': [CAutoHeadlightService]");
m_eStatus = sdv::EObjectStatus::initialization_failure;
return;
return false;
}
// Register Current Latitude change event handler.
@@ -49,32 +51,17 @@ void CAutoHeadlightService::Initialize(const sdv::u8string& ssObjectConfig)
pCurrentLongitudeSvc->RegisterOnSignalChangeOfFCurrentLongitude(static_cast<vss::Vehicle::Position::CurrentLongitudeService::IVSS_SetCurrentLongitude_Event*> (this));
if(LoadGPSBounds(ssObjectConfig))
{
SDV_LOG_INFO("AutoHeadlightService: GPS bounds loaded Successfully");
m_eStatus = sdv::EObjectStatus::initialized;
}
else
{
SDV_LOG_ERROR("AutoHeadlightService: GPS bounds could not be loaded");
m_eStatus = sdv::EObjectStatus::initialization_failure;
return;
}
// Swap the bounding box the make certain that min is less than max
if (m_SGPSBoundingBox.fTunnelMinLat > m_SGPSBoundingBox.fTunnelMaxLat)
std::swap(m_SGPSBoundingBox.fTunnelMinLat, m_SGPSBoundingBox.fTunnelMaxLat);
if (m_SGPSBoundingBox.fTunnelMinLon > m_SGPSBoundingBox.fTunnelMaxLon)
std::swap(m_SGPSBoundingBox.fTunnelMinLon, m_SGPSBoundingBox.fTunnelMaxLon);
SDV_LOG_INFO("AutoHeadlightService: Initialized Successfully");
return true;
}
sdv::EObjectStatus CAutoHeadlightService::GetStatus() const
{
return m_eStatus;
}
void CAutoHeadlightService::SetOperationMode(sdv::EOperationMode /*eMode*/)
{
// Not applicable
}
void CAutoHeadlightService::Shutdown()
void CAutoHeadlightService::OnShutdown()
{
// Unregister the Current latitude event handler.
auto pCurrentLatitudeSvc = sdv::core::GetObject("Vehicle.Position.CurrentLatitude_Service").GetInterface<vss::Vehicle::Position::CurrentLatitudeService::IVSS_GetCurrentLatitude>();
@@ -139,57 +126,6 @@ void CAutoHeadlightService::ProcessHeadlightBasedOnEgoPosition()
}
}
bool CAutoHeadlightService::LoadGPSBounds(const sdv::u8string& rssObjectConfig)
{
try
{
sdv::toml::CTOMLParser config(rssObjectConfig.c_str());
sdv::toml::CNode fStartLatNode = config.GetDirect("tunnel_start_lat");
float fTunnelStartLat = 0.0; ///< Tunnel Start Latitude
if (fStartLatNode.GetType() == sdv::toml::ENodeType::node_floating_point)
{
fTunnelStartLat = static_cast<float>(fStartLatNode.GetValue());
}
sdv::toml::CNode fStartLonNode = config.GetDirect("tunnel_start_lon");
float fTunnelStartLon = 0.0; ///< Tunnel Start Longitude
if (fStartLonNode.GetType() == sdv::toml::ENodeType::node_floating_point)
{
fTunnelStartLon = static_cast<float>(fStartLonNode.GetValue());
}
sdv::toml::CNode fEndLatNode = config.GetDirect("tunnel_end_lat");
float fTunnelEndLat = 0.0; ///< Tunnel End Latitude
if (fEndLatNode.GetType() == sdv::toml::ENodeType::node_floating_point)
{
fTunnelEndLat = static_cast<float>(fEndLatNode.GetValue());
}
sdv::toml::CNode fEndLonNode = config.GetDirect("tunnel_end_lon");
float fTunnelEndLon = 0.0; ///< Tunnel End Longitude
if (fEndLonNode.GetType() == sdv::toml::ENodeType::node_floating_point)
{
fTunnelEndLon = static_cast<float>(fEndLonNode.GetValue());
}
// Calculate bounding box
m_SGPSBoundingBox.fTunnelMinLat = std::min(fTunnelStartLat, fTunnelEndLat);
m_SGPSBoundingBox.fTunnelMaxLat = std::max(fTunnelStartLat, fTunnelEndLat);
m_SGPSBoundingBox.fTunnelMinLon = std::min(fTunnelStartLon, fTunnelEndLon);
m_SGPSBoundingBox.fTunnelMaxLon = std::max(fTunnelStartLon, fTunnelEndLon);
}
catch (const sdv::toml::XTOMLParseException& e)
{
SDV_LOG_ERROR("Parsing error: ", e.what());
return false;
}
return true;
}
IAutoheadlightService::SGPSBoundBox CAutoHeadlightService::GetGPSBoundBox() const
{
SGPSBoundBox tunnel;