Skip to content

Commit

Permalink
feat: add gnss packages (autowarefoundation#23)
Browse files Browse the repository at this point in the history
* rename gnss package (autowarefoundation#714)

Signed-off-by: Yamato Ando <yamato.ando@gmail.com>

* Avoid setting CMAKE_BUILD_TYPE=Release in each CMakeLists.txt (autowarefoundation#720)

* remove set CMAKE_BUILD_TYPE Release in each CMakeLists.txt

* remove set CMAKE_BUILD_TYPE Release in ndt_pcl_modified

* set compile options for debug in ndt_omp

* Fix indent

* add warning if -DCMAKE_BUILD_TYPE=Release is not set in ndt_omp

Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

* remove ROS1 packages temporarily

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* Revert "remove ROS1 packages temporarily"

This reverts commit bc523d679e6737ec37be4fdcbdedca141411bd9d.

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* add COLCON_IGNORE to ros1 packages

Signed-off-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>

* ROS2 Porting: geo_pos_conv (#8)

* Convert to ROS2 package
 - Update changelog -> 2.0.0
 - Update package xml to use the ROS2 xml schema
 - Update CMakelist with ament cmake commands
 - Add ROS2 compile options

* Convert CMakelist for foxy

* Clean up
 - Remove comments

* Remove colcon ignore

* Rename launch files to launch.xml (autowarefoundation#28)

* ROS2 Porting: gnss_poser (autowarefoundation#18)

* Fix CMakelist
 - Add ublox_msgs package dependency
 - Rename header files to use the .hpp extention
 - Remove colcon ignore
 - Fix Cmake ref to ublox in dependency

* Fix compilation issues with convert.hpp
 - Add sensor_msgs::NavSatFix header which was missing before (?)
 - Remove logging for now
 - Contains warnings - geographic lib error polymorphous error
 - Fix geographic lib -Wcatch-value warnings
 - Add ifndef guard in gnss_stat.hpp

* First pass - successful compilation
 - Fix CMakelist geographic library
 - Remove references to main ROS functions
 - Convert msg references
 - Add ifndef guards
 - Convert tf2 methods
 - Add functionality back
 - Fix type errors

* Add publishers and subscribers
 - Add parameters

* Convert launch files to ROS2 format

* Add logging

* Convert to component

* Fix define guards to follow ROS2/Google style

* Add -Werror compile flag

* Clean up

* Fix CMakelist to allow for the node to be found via ros2 launch
 - Revert filenames so it is easier to review

* Address PR Comments:
 - Fix CMakelist and package.xml
 - Remove redundant depend/exec_depend calls
 - Remove redundant find_package calls
 - Explicitly add headers to the library

* Address PR comments:
 - Revert removal of GNSSPoser namespace
 - Use std::make_shared in place of new
 - Reorder includes to conform with standard

* Address PR Comments:
 - Rename variable to conform with the google style guide
 - Use the node clock in logging method calls

* Address PR Comment:
 - Convert transform broadcaster to shared pointer

* Address PR comment:
 - Remove -Werror compile flag post discussion

* fix duration unit for RCLCPP_*_THROTTLE (autowarefoundation#75)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* [gnss_poser] switch broadcaster to full member... (autowarefoundation#136)

instead of `shared_ptr` to avoid undefined behavior when executing the node because it used `shared_from_this()` in the constructor

* Adjust copyright notice on 532 out of 699 source files (autowarefoundation#143)

* Use quotes for includes where appropriate (autowarefoundation#144)

* Use quotes for includes where appropriate

* Fix lint tests

* Make tests pass hopefully

* Run uncrustify on the entire Pilot.Auto codebase (autowarefoundation#151)

* Run uncrustify on the entire Pilot.Auto codebase

* Exclude open PRs

* ROS2 Linting: geo_pos_conv (autowarefoundation#165)

* Add linters and fix linter issues
 - convert Cmake to use ament_cmake_auto

* Address PR comments:
 - Remove unneeded cast
 - Throw error instead of setting default values to zero

* ROS2 Linting: gnss_poser (autowarefoundation#166)

* Add linting and fix litner errors

* Address PR comment:
 - Use author name instead of user
 - Remove ROS2 maintainer (remnants of older porting)

* apply env_var to  use_sim_time (autowarefoundation#222)

* [gnss_poser] fix namespace for component (autowarefoundation#295)

Signed-off-by: Takamasa Horibe <horibe.takamasa@gmail.com>

* [gnss_poser] fix link to Geographiclib (autowarefoundation#296)

* [gnss_poser] fix link to Geographiclib

* Fix mismatching spaces inside () after command

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: Autoware <autoware@tier4.jp>
Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Ros2 v0.8.0 gnss poser (autowarefoundation#287)

* [gnss poser]: Remove std_msgs (autowarefoundation#341)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* add use_sim-time option (autowarefoundation#454)

* Format launch files (autowarefoundation#1219)

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix for rolling (autowarefoundation#1226)

* Replace doc by description

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Replace ns by push-ros-namespace

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Remove use_sim_time for set_parameter (autowarefoundation#1260)

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Add pre-commit (autowarefoundation#1560)

* add pre-commit

* add pre-commit-config

* add additional settings for private repository

* use default pre-commit-config

* update pre-commit setting

* Ignore whitespace for line breaks in markdown

* Update .github/workflows/pre-commit.yml

Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>

* exclude svg

* remove pretty-format-json

* add double-quote-string-fixer

* consider COLCON_IGNORE file when seaching modified package

* format file

* pre-commit fixes

* Update pre-commit.yml

* Update .pre-commit-config.yaml

Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: pre-commit <pre-commit@example.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>

* Add markdownlint and prettier (autowarefoundation#1661)

* Add markdownlint and prettier

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Ignore .param.yaml

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Apply format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* suppress warnings for sensing packages (autowarefoundation#1729)

* add Werror for tier4_pcl_extensions

* use std::type  instead of pcl::type

* use std::isfinite instead of pcl_isfinite

* fix getFieldIndex

* add Werror

* fix uninitialized

* add Werror

* fix string to char*

* Fix -Wunused-parameter (autowarefoundation#1836)

* Fix -Wunused-parameter

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix mistake

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* fix spell

* Fix lint issues

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Ignore flake8 warnings

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>

* Fix clang warnings (autowarefoundation#1859)

* Fix -Wreturn-std-move

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix -Wunused-private-field

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Ignore -Wnonportable-include-path for mussp

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix -Wunused-const-variable

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix "can not be used when making a shared object"

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* add sort-package-xml hook in pre-commit (autowarefoundation#1881)

* add sort xml hook in pre-commit

* change retval to exit_status

* rename

* add prettier plugin-xml

* use early return

* add license note

* add tier4 license

* restore prettier

* change license order

* move local hooks to public repo

* move prettier-xml to pre-commit-hooks-ros

* update version for bug-fix

* apply pre-commit

* fix gnss_poser transform (autowarefoundation#1493) (autowarefoundation#1623)

* fix gnss_poser transform (autowarefoundation#1493)

* fix gnss_poser transform

* change transformation method from doTransform to tf2::Transform multiplication

* rename tf variables

* correct variable spelling

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

* Fix lint

Signed-off-by: wep21 <border_goldenmarket@yahoo.co.jp>

Co-authored-by: hiro-ya-iv <30652835+hiro-ya-iv@users.noreply.github.com>

* Change formatter to clang-format and black (autowarefoundation#2332)

* Revert "Temporarily comment out pre-commit hooks"

This reverts commit 748e9cdb145ce12f8b520bcbd97f5ff899fc28a3.

* Replace ament_lint_common with autoware_lint_common

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Remove ament_cmake_uncrustify and ament_clang_format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Apply Black

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Apply clang-format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix build errors

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix for cpplint

* Fix include double quotes to angle brackets

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Apply clang-format

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Fix build errors

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* Add COLCON_IGNORE (autowarefoundation#500)

Signed-off-by: Kenji Miyake <kenji.miyake@tier4.jp>

* remove COLCON_IGNORE (autowarefoundation#515)

* doc gnss poser (autowarefoundation#580)

* add minimal doc

* fix document title

* doc geo conv pos (autowarefoundation#573)

* add minimal doc

* fix document title

* Remove template comments from node documents (autowarefoundation#608)

* rename document file

* remove template comment

Co-authored-by: YamatoAndo <yamato.ando@gmail.com>
Co-authored-by: Daichi Murakami <harihitode@gmail.com>
Co-authored-by: Kenji Miyake <31987104+kenji-miyake@users.noreply.github.com>
Co-authored-by: mitsudome-r <ryohsuke.mitsudome@tier4.jp>
Co-authored-by: Jilada Eccleston <jilada.eccleston@gmail.com>
Co-authored-by: Nikolai Morin <nnmmgit@gmail.com>
Co-authored-by: Takamasa Horibe <horibe.takamasa@gmail.com>
Co-authored-by: Frederik Beaujean <72439809+fred-apex-ai@users.noreply.github.com>
Co-authored-by: Kosuke Murakami <kosuke.murakami@tier4.jp>
Co-authored-by: Ryohsuke Mitsudome <43976834+mitsudome-r@users.noreply.github.com>
Co-authored-by: Autoware <autoware@tier4.jp>
Co-authored-by: wep21 <border_goldenmarket@yahoo.co.jp>
Co-authored-by: Daisuke Nishimatsu <42202095+wep21@users.noreply.github.com>
Co-authored-by: tkimura4 <tomoya.kimura@tier4.jp>
Co-authored-by: Keisuke Shima <19993104+KeisukeShima@users.noreply.github.com>
Co-authored-by: Kazuki Miyahara <kmiya@outlook.com>
Co-authored-by: pre-commit <pre-commit@example.com>
Co-authored-by: Hiroki OTA <hiroki.ota@tier4.jp>
Co-authored-by: hiro-ya-iv <30652835+hiro-ya-iv@users.noreply.github.com>
Co-authored-by: Satoshi OTA <44889564+satoshi-ota@users.noreply.github.com>
Co-authored-by: taikitanaka3 <65527974+taikitanaka3@users.noreply.github.com>
  • Loading branch information
22 people authored Dec 3, 2021
1 parent d3258c9 commit 05b2bba
Show file tree
Hide file tree
Showing 15 changed files with 1,462 additions and 0 deletions.
203 changes: 203 additions & 0 deletions sensing/geo_pos_conv/CHANGELOG.rst
Original file line number Diff line number Diff line change
@@ -0,0 +1,203 @@
^^^^^^^^^^^^^^^^^^^^^^^^^^
Changelog for package geo_pos_conv
^^^^^^^^^^^^^^^^^^^^^^^^^^

2.0.0 (2020-10-03)
------------------
* Convert package to ROS2

1.11.0 (2019-03-21)
-------------------
* add constructor (`#1913 <https://github.com/CPFL/Autoware/issues/1913>`_)
* Fix license notice in corresponding package.xml
* Contributors: YamatoAndo, amc-nu

1.10.0 (2019-01-17)
-------------------
* Switch to Apache 2 license (develop branch) (`#1741 <https://github.com/CPFL/Autoware/issues/1741>`_)
* Switch to Apache 2
* Replace BSD-3 license header with Apache 2 and reassign copyright to the
Autoware Foundation.
* Update license on Python files
* Update copyright years
* Add #ifndef/define _POINTS_IMAGE_H\_
* Updated license comment
* Contributors: Esteve Fernandez

1.9.1 (2018-11-06)
------------------

1.9.0 (2018-10-31)
------------------

1.8.0 (2018-08-31)
------------------

1.7.0 (2018-05-18)
------------------
* update Version from 1.6.3 to 1.7.0 in package.xml and CHANGELOG.rst
* [fix] Fixes for all packages and dependencies (`#1240 <https://github.com/CPFL/Autoware/pull/1240>`_)
* Initial Cleanup
* fixed also for indigo
* kf cjeck
* Fix road wizard
* Added travis ci
* Trigger CI
* Fixes to cv_tracker and lidar_tracker cmake
* Fix kitti player dependencies
* Removed unnecessary dependencies
* messages fixing for can
* Update build script travis
* Travis Path
* Travis Paths fix
* Travis test
* Eigen checks
* removed unnecessary dependencies
* Eigen Detection
* Job number reduced
* Eigen3 more fixes
* More Eigen3
* Even more Eigen
* find package cmake modules included
* More fixes to cmake modules
* Removed non ros dependency
* Enable industrial_ci for indidog and kinetic
* Wrong install command
* fix rviz_plugin install
* FastVirtualScan fix
* Fix Qt5 Fastvirtualscan
* Fixed qt5 system dependencies for rosdep
* NDT TKU Fix catkin not pacakged
* More in detail dependencies fixes for more packages
* GLEW library for ORB
* Ignore OrbLocalizer
* Ignore Version checker
* Fix for driveworks interface
* driveworks not catkinpackagedd
* Missing catkin for driveworks
* libdpm opencv not catkin packaged
* catkin lib gnss not included in obj_db
* Points2Polygon fix
* More missing dependencies
* image viewer not packaged
* Fixed SSH2 detection, added viewers for all distros
* Fix gnss localizer incorrect dependency config
* Fixes to multiple packages dependencies
* gnss plib and package
* More fixes to gnss
* gnss dependencies for gnss_loclaizer
* Missing gnss dependency for gnss on localizer
* More fixes for dependencies
Replaced gnss for autoware_gnss_library
* gnss more fixes
* fixes to more dependencies
* header dependency
* Debug message
* more debug messages changed back to gnss
* debud messages
* gnss test
* gnss install command
* Several fixes for OpenPlanner and its lbiraries
* Fixes to ROSInterface
* More fixes to robotsdk and rosinterface
* robotsdk calibration fix
* Fixes to rosinterface robotsdk libraries and its nodes
* Fixes to Qt5 missing dependencies in robotsdk
* glviewer missing dependencies
* Missing qt specific config cmake for robotsdk
* disable cv_tracker
* Fix to open planner un needed dependendecies
* Fixes for libraries indecision maker
* Fixes to libraries decision_maker installation
* Gazebo on Kinetic
* Added Missing library
* * Removed Gazebo and synchonization packages
* Renames vmap in lane_planner
* Added installation commands for missing pakcages
* Fixes to lane_planner
* Added NDT TKU Glut extra dependencies
* ndt localizer/lib fast pcl fixes
re enable cv_tracker
* Fix kf_lib
* Keep industrial_ci
* Fixes for dpm library
* Fusion lib fixed
* dpm and fusion header should match exported project name
* Fixes to dpm_ocv ndt_localizer and pcl_omp
* no fast_pcl anymore
* fixes to libdpm and its package
* CI test
* test with native travis ci
* missing update for apt
* Fixes to pcl_omp installation and headers
* Final fixes for tests, modified README
* * Fixes to README
* Enable industrial_ci
* re enable native travis tests
* Contributors: Abraham Monrroy, Kosuke Murakami

1.6.3 (2018-03-06)
------------------

1.6.2 (2018-02-27)
------------------
* Update CHANGELOG
* Contributors: Yusuke FUJII

1.6.1 (2018-01-20)
------------------
* update CHANGELOG
* Contributors: Yusuke FUJII

1.6.0 (2017-12-11)
------------------
* Prepare release for 1.6.0
* support all plane(1-19) in geo_pos_conv
* Contributors: Yamato ANDO, yukikitsukawa

1.5.1 (2017-09-25)
------------------
* Release/1.5.1 (`#816 <https://github.com/cpfl/autoware/issues/816>`_)
* fix a build error by gcc version
* fix build error for older indigo version
* update changelog for v1.5.1
* 1.5.1
* Contributors: Yusuke FUJII

1.5.0 (2017-09-21)
------------------
* Update changelog
* install target
* Contributors: Dejan Pangercic, Yusuke FUJII

1.4.0 (2017-08-04)
------------------
* version number must equal current release number so we can start releasing in the future
* added changelogs
* Contributors: Dejan Pangercic

1.3.1 (2017-07-16)
------------------

1.3.0 (2017-07-14)
------------------

1.2.0 (2017-06-07)
------------------

1.1.2 (2017-02-27 23:10)
------------------------

1.1.1 (2017-02-27 22:25)
------------------------

1.1.0 (2017-02-24)
------------------

1.0.1 (2017-01-14)
------------------

1.0.0 (2016-12-22)
------------------
* Initial commit for public release
* Contributors: Shinpei Kato
28 changes: 28 additions & 0 deletions sensing/geo_pos_conv/CMakeLists.txt
Original file line number Diff line number Diff line change
@@ -0,0 +1,28 @@
cmake_minimum_required(VERSION 3.5)
project(geo_pos_conv)

### Compile options
if(NOT CMAKE_CXX_STANDARD)
set(CMAKE_CXX_STANDARD 14)
set(CMAKE_CXX_STANDARD_REQUIRED ON)
set(CMAKE_CXX_EXTENSIONS OFF)
endif()
if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang")
add_compile_options(-Wall -Wextra -Wpedantic)
endif()

### Add dependencies
find_package(ament_cmake_auto REQUIRED)
ament_auto_find_build_dependencies()

### Create library
ament_auto_add_library(geo_pos_conv SHARED
src/geo_pos_conv.cpp
)

if(BUILD_TESTING)
find_package(ament_lint_auto REQUIRED)
ament_lint_auto_find_test_dependencies()
endif()

ament_auto_package()
21 changes: 21 additions & 0 deletions sensing/geo_pos_conv/README.md
Original file line number Diff line number Diff line change
@@ -0,0 +1,21 @@
# geo_pos_conv

## Purpose

The `geo_pos_conv` is a library to calculate the conversion between **x, y positions on the plane rectangular coordinate** and **latitude/longitude on the earth**.

## Inner-workings / Algorithms

## Inputs / Outputs

## Parameters

## Assumptions / Known limits

## (Optional) Error detection and handling

## (Optional) Performance characterization

## (Optional) References/External links

## (Optional) Future extensions / Unimplemented parts
56 changes: 56 additions & 0 deletions sensing/geo_pos_conv/include/geo_pos_conv/geo_pos_conv.hpp
Original file line number Diff line number Diff line change
@@ -0,0 +1,56 @@
// Copyright 2015-2019 Autoware Foundation
//
// 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.

#ifndef GEO_POS_CONV__GEO_POS_CONV_HPP_
#define GEO_POS_CONV__GEO_POS_CONV_HPP_

#include <math.h>

class geo_pos_conv
{
private:
double m_x; // m
double m_y; // m
double m_z; // m

double m_lat; // latitude
double m_lon; // longitude
double m_h;

double m_PLato; // plane lat
double m_PLo; // plane lon

public:
geo_pos_conv();
double x() const;
double y() const;
double z() const;

void set_plane(double lat, double lon);
void set_plane(int num);
void set_xyz(double cx, double cy, double cz);

// set llh in radians
void set_llh(double lat, double lon, double h);

// set llh in nmea degrees
void set_llh_nmea_degrees(double latd, double lond, double h);

void llh_to_xyz(double lat, double lon, double ele);

void conv_llh2xyz(void);
void conv_xyz2llh(void);
};

#endif // GEO_POS_CONV__GEO_POS_CONV_HPP_
22 changes: 22 additions & 0 deletions sensing/geo_pos_conv/package.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,22 @@
<?xml version="1.0"?>
<?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
<package format="3">
<name>geo_pos_conv</name>
<version>2.0.0</version>
<description>The ROS2 geo_pos_conv package</description>
<maintainer email="ryo.watanabe@tier4.jp">Ryo Watanabe</maintainer>
<maintainer email="tomo@axe.bz">Tomomi HORII</maintainer>
<!-- ROS2 -->
<license>Apache License 2.0</license>

<buildtool_depend>ament_cmake_auto</buildtool_depend>

<depend>rclcpp</depend>

<test_depend>ament_lint_auto</test_depend>
<test_depend>autoware_lint_common</test_depend>

<export>
<build_type>ament_cmake</build_type>
</export>
</package>
Loading

0 comments on commit 05b2bba

Please sign in to comment.