Commit Graph

1358 Commits

Author SHA1 Message Date
Axel ed6062e5dd Added new argument to recreate sensors in the replayer. 2021-04-01 12:32:30 +02:00
bernat 7580c682f6 Disable the minimum size of a network packet to be sent 2021-03-31 10:00:24 +02:00
Roel Algaba Brizuela e9fc29898f
Added wheel control (#3868)
* First version - Wheel direction changes

* Updated CHANGELOG.md

* Fix DVSCamera include error

* Updated vehicle wheels direction commands

* Reset files back to default state

* Removed files from PR.

* Updated changelog
2021-03-15 15:42:33 +01:00
Daniel Santos-Olivan a0d8de23bc Fix bug in get_up_vector() 2021-03-15 12:37:15 +01:00
bernat 0ec6a45563 Ignore any error from socket when closing it 2021-03-08 14:48:22 +01:00
Axel 7d135da9c6 Added shut_down function to TM. 2021-03-08 13:31:28 +01:00
Axel c5fe20ab60 Compilation fix 2021-03-08 13:31:28 +01:00
Axel 081bb4191f Add small wait in TM for the next tick. 2021-03-08 13:31:28 +01:00
Axel 26f4bbec5b Changed wait method for next frame. Undone changes to determinsm smoke test. 2021-03-08 13:31:28 +01:00
Axel bb05155688 Added missing constant. 2021-03-08 13:31:28 +01:00
Axel 61542fa488 Fixed memory leak when activating TM in some maps in asynchronous mode 2021-03-08 13:31:28 +01:00
Axel 3fc6bce36c Added JSON ingestion for chrono vehicle definition 2021-03-04 12:48:57 +01:00
doterop 37ae251d1e Fixed IsAlive 2021-03-03 12:12:40 +01:00
Jacopo Bartiromo 8ae9090be2 Changes in constant values
Added new constants
2021-03-02 13:01:58 +01:00
doterop f379c63d43 Added functions to initialize is_alive from episode information 2021-03-02 12:56:21 +01:00
doterop 8604f81b0a destroy_actor now returns a bool 2021-03-02 12:56:21 +01:00
Axel f45e0d7c08 Added substep algorithm for chrono. Added initial UE4 terrain detection with raycast. 2021-02-18 10:04:35 +01:00
Axel1092 14a634aa29 Added chrono compilation support for windows. 2021-02-18 10:04:35 +01:00
Axel 7c3367325f Added chrono library 2021-02-18 10:04:35 +01:00
Axel 3bb3b0d3d5 Revert "Fixed tm loosing control of cars with low fps"
This reverts commit 30fc87a11a.
2020-12-22 20:19:50 +01:00
Axel 30fc87a11a Fixed tm loosing control of cars with low fps 2020-12-22 16:12:26 +01:00
Daniel Santos-Olivan 07d0f66c30 Simulator: We return to sync frame but with lower timeout 2020-12-21 23:04:07 +01:00
Daniel Santos-Olivan 14c22d9267 Fix Async - FixedDeltaTime mode
In ApplySettings we also need to check that the FixedDeltaTime
is correctly set when asynchronous mode.
2020-12-18 22:43:46 +01:00
Daniel Santos-Olivan 846b24cfac Removed synchronization causing timeout in apply_settings 2020-12-18 22:43:46 +01:00
Daniel Santos-Olivan 5d7a978527 Corrected type to avoid compilations issues in windows. 2020-12-17 19:03:20 +01:00
Daniel Santos-Olivan 78aa7cb1bc ApplySettings now check the episode settings
This method now check that the episode settings have
effect in the server as expected.
2020-12-17 19:03:20 +01:00
Jacopo Bartiromo 5170ca5880 Extends mutex to TM stages 2020-12-16 22:02:45 +01:00
Daniel Santos-Olivan 8f6806be69 Added default arguments in PythonAPI for reset settings
Also exposed the reset_settings in the GenerateOpendriveWorld
2020-12-15 22:31:48 +01:00
Daniel Santos-Olivan 4aa97d09ef Added support for load/reload maps without disabling the synchronous mode
Now you can add the option of reset_settings=False for not returning
to default options when you load/reload maps.
By default, reset_settings=True so it does not change the current
behavior of the simulator.
2020-12-15 22:31:48 +01:00
Daniel Santos-Olivan fd18ad85a9 Fix problem with reload map in the new syncronous pipeline 2020-12-15 22:31:48 +01:00
Axel b0fc79a3a6 Updated CarSim API 2020-12-10 20:38:33 +01:00
Axel 802f941fae Added function to set custom carsim simfile. Added option to use ue4 carsim road definition or unreal callback method. 2020-12-10 20:38:33 +01:00
Axel 7739b5eb94 Added first CarSim integration to vehicle class. 2020-12-10 20:38:33 +01:00
doterop 30db7e21d4
Added culling control (#3656)
* Added culling configuration to settings

* Updated changelog
2020-12-09 15:22:20 +01:00
Axel cba230bc0d Added toggle to select deterministic/physically based ragdoll animation. 2020-12-03 12:24:24 +01:00
Daniel Santos-Olivan 3835de9b0d Added sweep wheel option to VehiclePhysicsControl 2020-12-03 12:24:24 +01:00
Axel ad58149d17 Fixed distance > 0.0 bug for landmark search. 2020-12-03 10:07:44 +01:00
Axel 6189aa59f6 Changed the default value of lane change record to match OpenDRIVE specification. 2020-11-25 11:50:00 +01:00
Axel 2fbae920b9 Fixed conversion of std::string to FString. 2020-11-25 09:23:45 +01:00
doterop c98eb974c6 Added Any as a filter option instead of None 2020-11-24 10:30:35 +01:00
doterop a95d3d74a8 Added filter by type 2020-11-24 10:30:35 +01:00
doterop ab16a64ffb Added type to EnvironmentObject 2020-11-24 10:30:35 +01:00
doterop 42d67c2d28 Moved bounding_box to actor 2020-11-20 15:03:03 +01:00
Daniel Santos-Olivan d3879a1c53 Removed warning in LibCarla 2020-11-11 11:17:52 +01:00
Praveen Kumar 50ed66ac2c Registration lock while frame re-allocation 2020-11-07 20:34:10 +01:00
Axel c7ca5d1b2b Review fixes 2020-11-05 16:15:02 +01:00
Axel 5a56cb38d5 Small update to default lane validities. 2020-11-05 16:15:02 +01:00
Axel d7d79c3a63 Fixed bug in waypoint.get_landmarks(). Removed landmarks with lane validity [0,0]. 2020-11-05 16:15:02 +01:00
Daniel Santos-Olivan f6da3d1718 Minor formatting changes 2020-11-05 14:25:04 +01:00
Daniel Santos-Olivan 301eb9032e Changed default substepping parameters 2020-11-05 14:25:04 +01:00
Daniel Santos-Olivan 1c08f651d4 Added warnings for substepping parameters. 2020-11-05 14:25:04 +01:00
Daniel Santos-Olivan bbd3f4df4f Added substepping options in world options
Now, we can modify the substepping in the client.
TODO: Remove Logs
2020-11-05 14:25:04 +01:00
doterop 8f1b401e49
Adding load control on sublevels (#3515)
* Added MapLayer enum

* Added Load/Unload layer functions

* Added calls to register and tag objects on map change

* Added missing file

* Updated MapLayer to support more layers

* Added calls to PythonAPI

* Added default value

* Moved CurrentMapLayer to GI

* Updated manual_control with maplayer handling

* Updated help

* Updated Changelog

* Fixed a missing `;`

* Fixed LoadWorld() API so it works with old code

* Added missing include for shipping builds

* Fixed base enum type of MapLayer

* Removed int number from layer output

* Renamed variables

* MapLayer converted to int32 and added generic enumToString function

* MapLayer back to uint16

Co-authored-by: Marc Garcia Puig <marcgpuig@gmail.com>
2020-11-02 11:22:49 +01:00
adsim d1321419b2 drawbuffer:fix compile error on windows 2020-10-30 10:33:48 +01:00
adsim b1fe99b7df fix stuck in DrawBuffer at LocalizationStage 2020-10-30 10:33:48 +01:00
Marc Garcia Puig a53c697f69 Sync IMU transforms 2020-10-27 17:22:02 +01:00
Axel1092 003e74fc91
Raycasting (#3483)
* Added raycasting and point projection capabilities to python api.

* Added documentation of new functions.

* Fixed missing .f on floats

Co-authored-by: doterop <daniel.oterop@gmail.com>
2020-10-26 11:13:35 +01:00
Jacopo Bartiromo 52d706014b Remove TM's Traffic Light reset, and use the new one from World instead 2020-10-26 09:07:58 +01:00
Jacopo Bartiromo a66906d153 Removes debug prints 2020-10-21 11:47:23 +02:00
Jacopo Bartiromo 4052fa4be6 Fixes vehicle elimination algorithm 2020-10-21 11:47:23 +02:00
Praveen Kumar 7f6c2b3594 Adding null checks in LocalizationStage::ExtendAndFindSafeSpace 2020-10-21 11:47:03 +02:00
Axel 530f56e78b Changed LaneType enum from unsigned to signed type 2020-10-20 16:24:00 +02:00
Pasch, Frederik fddf3c9b2e Update ad-rss-lib to 4.4.0 2020-10-20 14:41:19 +02:00
doterop 2fbfda2f24 Renamed and added enable/disable call 2020-10-19 21:31:45 +02:00
doterop 8aedb57a97 Updated mesh with objectlabel 2020-10-19 21:31:45 +02:00
doterop df6e6eef65 Renamed object to mesh 2020-10-19 21:31:45 +02:00
doterop 374995b835 Added CarlaObject and objects function. 2020-10-19 21:31:45 +02:00
Jacopo Bartiromo 859dfffb5e Sorts vehicles by ID to avoid race condition in TM 2020-10-14 11:16:40 +02:00
bernat 76a1e95c6f Make function 'const' 2020-10-07 10:56:04 +02:00
bernat 4550573b5e Let skip messages in async, and block on sync mode 2020-10-07 10:56:04 +02:00
bernat 1d91e187c3 Avoid deadlock at high frame rate by race condition packets 2020-10-07 10:56:04 +02:00
Daniel Santos-Olivan 7bd1d6e920 SetEnableGravity fixed for pedestrians
Also removed some debug prints
2020-09-30 19:38:54 +02:00
Daniel Santos-Olivan 95abf25a10 Added EnableGravity and better SetSimulatePhysics 2020-09-30 19:38:54 +02:00
doterop e05b58c2a4
Retrieve BBs of level (#3360)
* Added new function to calculate BBs on SKM and SM

* Added BB calculation for an array of actors

* Added BB folliage calculation

* Added a call on the GM to get all the BBs of the level

* Fixed Folliage BB calculation.

* GM::GetAllBBsOfLevel now returns the array of BBs

* Added call on the server side to retrieve the BBs

* Removed debug draw calls

* Added call to the PythonAPI

* Added check for empty folliage actors

* Added missing EOF

* Added new RotateVector function

* Added rotation to the BBs

* Update changelog

* Split BB calculation on more functions

* Add tag query and simplified Folliage actor BB calculation

* Look for ISM instead of HISM

* Cleaning comments

* Fixed BB duplication on BP_Procedural_Buildings

* Fixed BB duplication on vehicles BPs

* Added pedestrians case

* Added CityObjectLabel enum on PythonAPI

* Splitted logic in small functions

* Fixed uint8_t

* Merged BB of the lights in a TL

* Splitted work into more functions

* Added missing BB and rotation to TL

* Cleaned comments

* Added missing include

* Changed None to Any in PythonAPI

* Fixed Any enum

* Added check for empty folliage actors

* Added missing EOF

* Added new RotateVector function

* Added rotation to the BBs

* Update changelog

* Split BB calculation on more functions

* Add tag query and simplified Folliage actor BB calculation

* Look for ISM instead of HISM

* Cleaning comments

* Fixed BB duplication on BP_Procedural_Buildings

* Fixed BB duplication on vehicles BPs

* Added pedestrians case

* Added CityObjectLabel enum on PythonAPI

* Splitted logic in small functions

* Fixed uint8_t

* Merged BB of the lights in a TL

* Splitted work into more functions

* Added missing BB and rotation to TL

* Cleaned comments

* Changed None to Any in PythonAPI

* Fixed Any enum

* Fixed rebase

* Fixing wrong BB on splines

* Fixed ISM transform to World

* Fixed duplication of RotateVector

* Added Rotation to BB output string

* Removed hidden components and procedural building

* Fixed string BB output

* Removed logs

* Fixed filter on pedestrians

* Fixed black debug lines in package

Co-authored-by: Marc Garcia Puig <marcgpuig@gmail.com>
2020-09-24 23:33:11 +02:00
Jacopo Bartiromo 7d91a14fae Fixes float conversion in TM 2020-09-24 16:18:20 +02:00
Jacopo Bartiromo a4799d5fa8 Minor change to warning message 2020-09-23 20:43:30 +02:00
Jacopo Bartiromo e7ff12fa78 Changes default behavior for OSM parameter in TM 2020-09-23 20:43:30 +02:00
Daniel Santos-Olivan ffabf4cf3e Added ApplyForce and ApplyTorque 2020-09-23 20:40:44 +02:00
Daniel Santos-Olivan a22bdc51cc Added commands for AddTorque and AddForce 2020-09-23 20:40:44 +02:00
Daniel Santos-Olivan 30ba2b3323 Exposed AddForce and AddTorque 2020-09-23 20:40:44 +02:00
Daniel Santos-Olivan 2edd5427cb Minor format changes 2020-09-23 20:40:44 +02:00
Daniel Santos-Olivan 4447661d66 First version of the Constant velocity mode
This mode can be enabled in the API and it will keep
a velocity constant.
For now, it needs to be disable automatically but this
can be improved in the future.
2020-09-23 20:40:44 +02:00
Jacopo Bartiromo 0c83622153
Support Off state for traffic lights in Traffic Manager (#3332)
* Support off state for traffic lights in Traffic Manager

* Removed off state workarround.

Co-authored-by: Axel <axellopez92@outlook.com>
2020-09-22 15:41:10 +02:00
Jacopo Bartiromo 7360436c9d
Determinism for Traffic Manager (#3333)
* Check for determinism

* Per-vehicle random device

* Parameterised random device seed.

* Changing next waypoint selection logic
to use bucketing random device sample.

Arranging next waypoint selections right to left.

* Change to numpy's random lib

* Sorting blueprints to ensure determinism

* New method for determinism

* ResetAllTrafficLight now works in sync mode.

* Moving recorder stuff to engine module

* Fixed recorder for traffic lights in standalone mode.

* Added check to prevent traffic light from updating during replay.

* Updating old traffic lights to use the traffic light component.

* Moved recorder to posttick.

* Small fix to elapse time function.

* Added reset group function to API.

* Merge with traffic_manager/determinism_check

* Changes in TL reset
Option to save to file for recorder script

* Added automatic signal match with OpenDRIVE.

* Fixed error that caused traffic light actors to be missing in client side.

* Added new frozen behavior.

* Updated documentation and changelog

* Updated ContentVersions.txt

* Review changes.

* fixes merge error

* fixes merge

* Update build_windows.md

Added info about command execution that toke me many time to find out

* Update build_windows.md

Updated as requested in pull request review

* Running Carla when choosing a) deb Carla install

This fixes a minor error in the documentation regarding running carla, if the deb installation was choosen.

* Fix for traffic manager freezing upon map change

* attempt to change sys clock to sim clock

* Remove manual unlock of mutex

* fixing merge error

* Changelog and review fixes

Co-authored-by: Praveen Kumar <pravinblaze@hotmail.com>
Co-authored-by: bernat <bernatx@gmail.com>
Co-authored-by: Axel1092 <axellopez92@outlook.com>
Co-authored-by: Axel1092 <35765780+Axel1092@users.noreply.github.com>
Co-authored-by: Néstor Sabater <web.nsabater@gmail.com>
Co-authored-by: ll7 <32880741+ll7@users.noreply.github.com>
2020-09-22 15:20:52 +02:00
Axel 4f5b66b0a0 Changed call type for traffic light syncronization. 2020-09-22 15:04:28 +02:00
Axel a75fc59eb0 Added reset all traffic lights function. 2020-09-22 15:04:28 +02:00
Daniel Santos-Olivan 9f5758577d SetVelocity -> SetTargetVelocity
Change the commands set_velocity to set_target_velocity
for both linear and angular velocities.
2020-09-22 12:00:22 +02:00
doterop cc7b1ea910
Retrieve BBs of all the elements of the level (#3301)
* Added new function to calculate BBs on SKM and SM

* Added BB calculation for an array of actors

* Added BB folliage calculation

* Added a call on the GM to get all the BBs of the level

* Fixed Folliage BB calculation.

* GM::GetAllBBsOfLevel now returns the array of BBs

* Added call on the server side to retrieve the BBs

* Removed debug draw calls

* Added call to the PythonAPI

* Added check for empty folliage actors

* Added missing EOF

* Added new RotateVector function

* Added rotation to the BBs

* Update changelog

* Split BB calculation on more functions

* Add tag query and simplified Folliage actor BB calculation

* Look for ISM instead of HISM

* Cleaning comments

* Fixed BB duplication on BP_Procedural_Buildings

* Fixed BB duplication on vehicles BPs

* Added pedestrians case

* Added CityObjectLabel enum on PythonAPI

* Splitted logic in small functions

* Fixed uint8_t

* Merged BB of the lights in a TL

* Splitted work into more functions

* Added missing BB and rotation to TL

* Cleaned comments

* Added missing include

* Changed None to Any in PythonAPI

* Fixed Any enum

* Added check for empty folliage actors

* Added missing EOF

* Added new RotateVector function

* Added rotation to the BBs

* Update changelog

* Split BB calculation on more functions

* Add tag query and simplified Folliage actor BB calculation

* Look for ISM instead of HISM

* Cleaning comments

* Fixed BB duplication on BP_Procedural_Buildings

* Fixed BB duplication on vehicles BPs

* Added pedestrians case

* Added CityObjectLabel enum on PythonAPI

* Splitted logic in small functions

* Fixed uint8_t

* Merged BB of the lights in a TL

* Splitted work into more functions

* Added missing BB and rotation to TL

* Cleaned comments

* Changed None to Any in PythonAPI

* Fixed Any enum

* Fixed rebase
2020-09-21 18:22:03 +02:00
Praveen Kumar f3d357d7d0 Implemented vehicle removal in OSM mode. 2020-09-18 14:55:14 +02:00
Praveen Kumar bc5871330a Implemented parameter for OSM mode. 2020-09-18 14:55:14 +02:00
Axel 7bbb7f9c54 Fixed ugly z-fighting issue with OSM maps. Added AProceduralMeshActor for easier actor inspection in the editor. 2020-09-17 18:35:30 +02:00
Jacopo Bartiromo 14900e3bb7 fixes std::numeric_limits<float>::epsilon error 2020-09-17 15:51:21 +02:00
Jacopo Bartiromo 318681e276 fixes add entry issue 2020-09-17 15:49:07 +02:00
Marc Garcia Puig 0a837ff1a0 Fixed bad_weak_ptr + updated deprecated asio calls 2020-09-16 13:12:02 +02:00
Jacopo Bartiromo 4757ce4dcc
Fixes a map change error when TM is in synchronous mode (#3288)
* Update build_windows.md

Added info about command execution that toke me many time to find out

* Update build_windows.md

Updated as requested in pull request review

* Running Carla when choosing a) deb Carla install

This fixes a minor error in the documentation regarding running carla, if the deb installation was choosen.

* Fix for traffic manager freezing upon map change

* Remove manual unlock of mutex

Co-authored-by: Néstor Sabater <web.nsabater@gmail.com>
Co-authored-by: ll7 <32880741+ll7@users.noreply.github.com>
Co-authored-by: Praveen Kumar <pravinblaze@hotmail.com>
Co-authored-by: bernat <bernatx@gmail.com>
2020-09-16 13:11:04 +02:00
doterop 5bdd65ca0e Added call to the PythonAPI 2020-09-10 15:48:22 +02:00
bernat e8f103c786 Remove unused .xodr parsing call 2020-09-09 23:07:34 +02:00
Pasch, Frederik 5f67e28821 Update RSS library to 4.1.0
Add setMapLogLevel() to rss sensor API
2020-09-03 16:15:54 +02:00
Marc Garcia Puig b15f0d2d50 Added Terrain sem seg label 2020-09-02 14:44:42 +02:00
Marc Garcia Puig aabde2182b Small color fix 2020-09-02 14:44:42 +02:00
Marc Garcia Puig 564a15989b Added sem seg water and changed Dynamic color 2020-09-02 14:44:42 +02:00
Marc Garcia Puig 8cff64fd00 Added new semantic tags 2020-09-02 14:44:42 +02:00
bernat d23ce106bc Add stop for the replayer 2020-07-31 16:38:41 +02:00
Marc Garcia Puig 3d3e82f8ad Added Sky, Ground and Bridge 2020-07-31 15:16:06 +02:00
Daniel Santos-Olivan 96d0ae27e6 Refactor SemanticLidar in LibCarla and PythonAPI 2020-07-31 15:15:01 +02:00
Daniel Santos-Olivan e0430e66a1 Refactor SemanticLidar in server side. 2020-07-31 15:15:01 +02:00
Jacopo Bartiromo c2cc075d23 Changes in apply batch command for async mode 2020-07-31 15:14:14 +02:00
Daniel Santos-Olivan 0ea498f744 Indentation correction 2020-07-30 15:16:42 +02:00
Daniel Santos-Olivan 53f54ee0b7 Fix minor header return. 2020-07-30 15:16:42 +02:00
Daniel Santos-Olivan 92892ec8e9 Rewrite of RayCastLidar to inherit from RayCastRawLidar
to reuse code
2020-07-30 15:16:42 +02:00
Daniel Santos-Olivan 12cf111a45 Rewrite the RayCastRawLidar to store all info
- We needed to change completly the way we store and compute
  the data because for some reason we could access the actor
  information from the computation threads so we store all
  the FHitResult in the Sensor and then we compute the Detection
  information when we store in the LidarRawData structure.
2020-07-30 15:16:42 +02:00
Daniel Santos-Olivan 3c5f051f93 Changed data structures to data folder 2020-07-30 15:16:42 +02:00
Daniel Santos-Olivan 3e1f17741c LidarRawData now inherits from LidarData to avoid repetion of code 2020-07-30 15:16:42 +02:00
Daniel Santos-Olivan 08e97be923 Rename LidarData and prepare it for merge it with LidarRawData 2020-07-30 15:16:42 +02:00
Daniel Santos-Olivan a4a9197c20 Removed unused file 2020-07-30 15:16:42 +02:00
Daniel Santos-Olivan 4f2fec1f64 Addapted PointCloud to both Lidars 2020-07-30 15:16:42 +02:00
Daniel Santos-Olivan e93f9d328d Added needed Writing functions to old lidar 2020-07-30 15:16:42 +02:00
Daniel Santos-Olivan fdb3553b2c Added data/serializer structures for RayLidar 2020-07-30 15:16:42 +02:00
Daniel Santos-Oliván f26ae8f8ac RayCastRawLidar: First version, still in a very early stage. 2020-07-30 15:16:42 +02:00
Axel cb431f1015 Removed debug warning. 2020-07-30 12:31:19 +02:00
Axel1092 7b455ce92e Compensate traffic light displacement. 2020-07-28 09:28:17 +02:00
Axel1092 215ceff451 Added stops in the ground from roadrunner. 2020-07-28 09:28:17 +02:00
Axel1092 284f1e726f Ficed conversion from object record to signal. 2020-07-28 09:28:17 +02:00
Axel1092 cbd12ac056 Added detection of 'Speed_' object record from roadrunner to interpret it as a speed signal. 2020-07-28 09:28:17 +02:00
Pasch, Frederik d20e6ef7ca RSS: Cleanup
- Only calculate for new frames
- Return calculation result
2020-07-23 12:59:37 +02:00
Pasch, Frederik e70480c664 RSS: Fix calculation of steering angle
As ad-rss-lib is using a right-handed and CARLA left-handed coordinate system, the calculation of the steering angle must be inverted

+ remove obsolete openscenario
2020-07-23 12:59:37 +02:00
Axel1092 64aa5b0396 Fixed road discretization for long geometries. 2020-07-17 20:04:58 +02:00
Bernd Gassmann 0332185e6f Update PythonAPI docu
+ Codeformatting of RSS parts
2020-07-14 17:53:28 +02:00
Pasch, Frederik 88ae9d04ae Update to AD RSS Library 4.0.0
- Added support for unstructured scenes and pedestrians.
- Rework rss example folder structure
- Python based debug drawing
- Handle negative speeds
- Fixes #2871 by linking libproj statically.
- Fixes #2958 by using sequential colcon build
- Allow setting log level
- Add ActorConstellationCallback
- Move setting of RssDynamics to python code
2020-07-14 17:53:28 +02:00
Axel1092 2d26512209 Added new frozen behavior. 2020-07-10 11:36:31 +02:00
Axel1092 07d016d318 Added reset group function to API. 2020-07-10 11:36:31 +02:00
Daniel Santos-Olivan 43e2809249 Added a warning when the SprintArm transformation
is ill formed.
2020-07-09 10:24:45 +02:00
Daniel Santos-Olivan 0d6a2ea184 Added default constructor for LidarDetection 2020-07-08 11:44:23 +02:00
Daniel Santos-Olivan 1926b68e70 Change variable name to adapt to code standard and added
stream operator for LidarDetection
2020-07-08 11:44:23 +02:00
Daniel Santos-Olivan 8e68cbdd8a Fix error in the serializer of LidarMeasurament. 2020-07-08 11:44:23 +02:00
Daniel Santos-Olivan a3ba5ca8f0 Change from xyz to rpc::Location 2020-07-08 11:44:23 +02:00
Daniel Santos-Olivan 1d9bb78a8d Format changes to answer review 2020-07-08 11:44:23 +02:00
Daniel Santos-Olivan 89da61292d Exposing the 4-matrix form of the transformation
to the client API
2020-07-08 11:44:23 +02:00
Daniel Santos-Olivan da2e29f5ef Lidar Intensity: Added intensity to lidar's output
For now, only takes into account the intensity loss
due to the the atmosphere atenuation.
2020-07-08 11:44:23 +02:00
Daniel Santos-Olivan 62e8b4ec1e Fix error in the inverse 4-matrix transformation 2020-07-02 12:22:12 +02:00
Daniel Santos-Olivan 1aa286f6a9 Added a getter to the 4-matrix form of the
inverse transformation for the client
2020-07-02 12:22:12 +02:00
Daniel Santos-Olivan 7e2b57338b Exposing the 4-matrix form of the transformation
to the client API
2020-07-02 12:22:12 +02:00
Axel1092 f39bc70242 Added velocity, acceleration and platform time to recorder. 2020-07-02 11:53:36 +02:00
bernat 315bfc45bf Trimming spaces and renaming variable 2020-06-30 13:12:22 +02:00
bernat b6639328ac Removing pointer to function, applying Nestor cleaner method 2020-06-30 13:12:22 +02:00
bernat acd85f0624 Made pointer to class method as atomic pointer 2020-06-30 13:12:22 +02:00
bernat 9b716e1698 All streams are multi stream now 2020-06-30 13:12:22 +02:00
Marc Garcia Puig 083d579961 Added default values for lanes missing width 2020-06-18 14:51:51 +02:00
Marc Garcia Puig f5bf74aafc Nagle's algorithm deactivation has been forced 2020-06-18 14:50:26 +02:00
doterop f114dc0aa1
Remove intermediate map when changing map. (#2911)
* Fixed load_new_episode and removed intermediate check.

* Recovered intermediate state.

* Removing intermediate map

* Fixing merge issue

* Remove unnecessary check in load_new_episode
2020-06-15 10:53:26 +02:00
Marc Garcia Puig 97cb2dfec0 Fixed fog_falloff in Boost Python 2020-06-10 14:43:21 +02:00
Marc Garcia Puig cd49cbc3b2 Fixed fog_falloff constructor 2020-06-10 14:43:21 +02:00
Marc Garcia Puig 07fe7a7153 Added weather parameter fog_fallow to PythonAPI 2020-06-10 14:43:21 +02:00
Praveen Kumar d2457a2e8c Implemented spatial index tree for
waypoint indexing and querying.
2020-06-09 15:26:02 +02:00
Marc Garcia Puig fc133121c7 Added get function for all car light states 2020-06-08 10:49:31 +02:00
Marc Garcia Puig 923960751f Added batch command SetVehicleLightState 2020-06-08 10:49:31 +02:00
Praveen Kumar 1e98335808
Traffic manager 2.0 (#2833)
* Traffic Manager 2.0

* WIP: new class structure for TM 2.0
Yet to use the new classes in TrafficManagerLocal

* WIP: new class structure integration

* Fix for python api build.

* Fix for hybrid mode crash.

* Fixed incorrect collision cache.
Fixed crash upon map change.
Minor reformatting.

* Fixed collisions with unregistered actors.
Fixed collisions among multiple traffic manager instances.
Fixed vehicle destruction upon being stuck for too long.

* Fixed vehicle wobble on steep roads

* Waypoint buffer extension at junction entrance.

* WIP: Revamped intersection anticipation.

* Implemented waypoint occupancy tracking.

* * considering buffer independent waypoints
for determining blocked junction exit.

* considering longitudinal extreme points
for localizing unregistered actors.

* Removed debug statements

* Intersection anticipation for vehicles moving across path.

* Fixed intersection anticipation in Town03, Town04.

* Safe interval length check for intersection anticipation.

* Distance check from safe interval for blocked exit.

* Removed debug statements

* * Intersection anticipation exception for roundabout in Town03.
* Updated comments.

* codacity fix

* more codacity fixes

* formatting and minor changes

* bad indentation

* Removed debug statements and updated comments.

* fixes unused variable error in make examples

* Increased minimum obstacle distance for lane change
to avoid partial lane changes.

* Removing crude stopping logic at junction entrance
for blocked junction case.

* Ignoring small intersection segments
for intersection anticipation.

* Fixed issue in unblocking mechanism
due to incorrect clock initialization.

* Fixing intersection entrance identification.

* Fixed incorrect safe space after junction detection.

* Fixed collision negotiation conditions
to work well inside intersections
and avoid deadlocks in roundabout turns.

* Replaced in file constants of InMemoryMap
with definitions from Constants.h

Updated comments

* Added a check to avoid collision considerations
in case  of traffic light hazard in motion planner.

* Re-organised include statements for ALSM.h/.cpp files.

Fixed a double initialization precision.

* WIP: Refactoring ALSM::Update

* Refactored ALSM::Update into shorter functions.

* ALSM: Corrected numeric comparision precision
and container access optimizations.

* Initial review changes

* CollisionStage: addressed pr comments.

* Constants.h, DataStructures.h: addressed pr review comments.

* InMemorMap: review comment addressal.

* LocalizationStage: Review comment addressal

* New class for random generation instead of rand()

* Removed unused code

* MotionPlanStage: re-organized include statements.

* MotionPlanStage: review comment addressal.

* SimulationState, DataStructures: minor refactoring.

* SnippetProfiler, TrackTraffic: Review comment addressal.

* Refactored include statements for
SimpleWaypoint, SnippetProfiler, TrackTraffic files.

* TrafficLightStage: review comment addressal.

* Using sleep instead of continue to time hybrid mode.

* Changing fixed array allocation with dynamic resizing.

* Refactored include statements for TrafficManager

* Removed clamp macro

* Added const to Networking constants

Co-authored-by: Jacopo Bartiromo <jackbart94@gmail.com>
Co-authored-by: Jacopo Bartiromo <32928804+jackbart94@users.noreply.github.com>
2020-06-05 00:02:10 +02:00
Néstor Subirón 66166399bb Fix wrong assert 2020-06-04 14:31:18 +02:00
Néstor Subirón ae6d327d1f Fix false positive assert in Array offset 2020-06-04 14:31:18 +02:00
Néstor Subirón 172aa55186 Fix threads not properly stopped on streaming tests 2020-06-04 14:31:18 +02:00
Néstor Subirón 4f11c03b94 Fix UB in MsgPack for empty strings 2020-06-04 14:31:18 +02:00
Néstor Subirón 15c250ad2a Fix division by zero 2020-06-04 14:31:18 +02:00
Axel1092 d26f69957f Added fast conversion from/to FString and std::string. 2020-05-29 12:34:29 +02:00
Marc Garcia Puig 3e8e6dc4de Fixed MeshFactory circular dependency 2020-05-29 12:34:29 +02:00
Axel1092 827368588d Updated docs and CHANGELOG. 2020-05-29 12:34:29 +02:00
Axel1092 cd277af189 Code clean up. 2020-05-29 12:34:29 +02:00
Axel1092 605c99136d Improved standalone mesh split. 2020-05-29 12:34:29 +02:00
Axel1092 543f502512 Fixed large RAM usage in cubic polinomial curves. 2020-05-29 12:34:29 +02:00
Axel1092 734912df54 Added optional recast execution. 2020-05-29 12:34:29 +02:00
Axel1092 381d6b2d97 Fixed string length limit in ToFString and FromFString in String.h. Fixed some parameters not used in standalone mode. 2020-05-29 12:34:29 +02:00
Javier Hidalgo-Carrió 26441431e4 DVSEventArray: boolean in +1 and -1. DVSCamera: set default threshold values 2020-05-08 20:08:27 +02:00
Javier Hidalgo-Carrió 38432de658 python api: move logic in sensor data methods to DVSEventArray 2020-05-08 20:08:27 +02:00
Marc Garcia Puig 9f5f4b9a2e Moved ToImage() and added a use case in man_contr 2020-05-08 20:08:27 +02:00
Marc Garcia Puig a55c71ad4f Added our standard noise to DVS sensor + Win fixes 2020-05-08 20:08:27 +02:00
Marc Garcia Puig 87ac3b9a6d Minor fixes and code style adaptation 2020-05-08 20:08:27 +02:00
Javier Hidalgo-Carrió c45614c983 DVS camera sensor implementation 2020-05-08 20:08:27 +02:00
Marc Garcia Puig 50d70709fc Fixed wrong operator 2020-05-08 12:12:57 +02:00
Marc Garcia Puig 3afd89074c Adjusten mesh generation EPSILON 2020-05-08 12:12:57 +02:00
Axel1092 f99a06f7e5 Bug fixes: poly geometries problems at s = 0, crash when computing junction bounding box, crash in GetNextUntilLaneEnd and GetPreviousUntilLaneStart for very short roads. 2020-05-08 12:12:57 +02:00
bernat b67ba6c3c9 Updating to master 2020-05-06 13:09:12 +02:00
Vaan5 06cbfa673d Add missing include in WheelPhysicsControl.h 2020-05-06 13:09:12 +02:00
bernat 4dc6eba755 New API function to add angular impulse to an actor 2020-05-05 11:16:23 +02:00
kbu9299 bcf542f579 Fix typos 2020-05-04 10:05:18 +02:00
kbu 9d66a06caf Correct the proper checking for left lane marking 2020-04-22 20:59:21 +02:00
Axel1092 ff97d65cc0 Fixed server-client sincronization for map change. 2020-04-22 20:58:46 +02:00
doterop 4384e386c2
Light API (#2756)
* Added CarlaLight class.

* Added get and set for carla light type.

* Added LightManager, Light and LightState

* Fixed unapplied changes

* Fixed LM::GetAllLights

* Fixed Python getter

* Added LightManager, Light and LightState. Python bindings included.

* Completed LightManager communication and LightSubsystem on server

* Fixed concurrency and color conversion

* Added check for null case on RegisterLight and UnregisterLight

* Fixed map change crash in editor.

* Added client syncronization.

* Updated Python docs.

* Fixed client sync

* Added CarlaLight class.

* Added get and set for carla light type.

* Added LightManager, Light and LightState

* Fixed unapplied changes

* Fixed LM::GetAllLights

* Fixed Python getter

* Added LightManager, Light and LightState. Python bindings included.

* Completed LightManager communication and LightSubsystem on server

* Fixed concurrency and color conversion

* Added check for null case on RegisterLight and UnregisterLight

* Fixed map change crash in editor.

* Added client syncronization.

* Updated Python docs.

* Fixed client sync

* Updated changelog

* New iteration on lights docs

* Fixed docs

* Content version updated

* Removed NonCopyable

* Compilation fix.

Co-authored-by: Axel1092 <axellopez92@outlook.com>
Co-authored-by: sergi-e <rigesklaine@gmail.com>
Co-authored-by: bernat <bernatx@gmail.com>
2020-04-17 12:29:54 +02:00
doterop 5d177eb4bb set_autopilot now uses the TM port instead of the TM object 2020-04-16 12:36:53 +02:00
Praveen Kumar 50281d7ecb Hot fix for PyEval error 2020-04-16 12:36:53 +02:00
bernat 4d448fc49c Removed some Epsion from calculations 2020-04-14 21:00:04 +02:00
Axel1092 6f3c4788d8 Added displacement to signals overlapping driving lanes. Fixed crash when closing spawn_npc with signals. 2020-04-14 21:00:04 +02:00
Marc Garcia Puig 0480feb230 Prevent sedewalks to be smoothed in junctions 2020-04-14 11:32:44 +02:00
Axel1092 6bcb390d1f Fixed crash when generating signals with an s position equal to the road length. 2020-04-13 18:26:11 +02:00
Marc Garcia Puig 3443a64db2 Fixed GetCornerPositions 2020-04-13 16:50:32 +02:00
Marc Garcia Puig d23e3d5f82 Fixed waypoint positive lanes offset heading 2020-04-13 16:50:32 +02:00
Marc Garcia Puig 1a9f87ff48 Fixed a rotation calculus error on lanes with positive id affected by a lane offset 2020-04-13 16:50:32 +02:00
Marc Garcia Puig 487d4e678b Some PR fixes 2020-04-13 16:50:32 +02:00
Marc Garcia Puig b28cb75273 Fixed codacy issue 2020-04-13 16:50:32 +02:00
Axel1092 d5c57e8903 Added parameter to enable/disable junction smooting. Moved config file variables to CarlaGameInstace for opendrive generation parameters. 2020-04-13 16:50:32 +02:00
Axel1092 c845db64e4 Rebase fix. 2020-04-13 16:50:32 +02:00
Axel1092 856979906e Split code into more functions. 2020-04-13 16:50:32 +02:00
Axel1092 ced9fccd18 Compilation fix. 2020-04-13 16:50:32 +02:00
Axel1092 6cc59261d8 Added modified laplacian smoothing for generated meshed in junctions. 2020-04-13 16:50:32 +02:00
Marc Garcia Puig e2c0349ef6 Exposed max chunk size to the PythonAPI 2020-04-13 16:50:32 +02:00
Axel1092 5ddb97a58e Added parameter to disable rendering meshes generated from OpenDRIVE. 2020-04-13 16:50:32 +02:00
Marc Garcia Puig 40ee5705d6 Added walls to the mesh chunks 2020-04-13 16:50:32 +02:00
Marc Garcia Puig 00a73c4f02 Splited the map generation in chunks 2020-04-13 16:50:32 +02:00
Marc Garcia Puig 832b293a33 Added MeshFactory + improved code architecture 2020-04-13 16:50:32 +02:00
codeffee 01f98aac07 Fixing Windows compilation errors and some warnings 2020-04-13 13:06:38 +02:00
doterop a108bf5b3b Updated default value for TM. Now should be retrocompatible. 2020-04-13 13:06:38 +02:00
doterop 66efc6ea17 Cleaned some TM includes 2020-04-13 13:06:38 +02:00
doterop 2f6b8e048f Change to support default parameter to keep compatibility 2020-04-13 13:06:38 +02:00
doterop 79d6298395 Cleaned logs 2020-04-13 13:06:38 +02:00
doterop 64cc616938 Added changes to SetAutopilot BatchCommand 2020-04-13 13:06:38 +02:00
doterop f2f4b229d7 Updated set_autopilot to get tm as a parameter 2020-04-13 13:06:38 +02:00
Praveen Kumar 6b1a5db4f6 Implemented carla::geom::Vector3D::MakeSafeUnitVector 2020-04-09 19:48:03 +02:00
Praveen Kumar ba6957b405 Magnitude guard on vector normalization. 2020-04-09 19:48:03 +02:00
berndgassmann b0787c0018
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-04-09 15:23:00 +02:00
Axel1092 9d76978f93 Fixed get_all_landmarks functions returning invalid landmarks when using world.get_map().get_all_landmarks(). 2020-04-09 14:47:49 +02:00
bernat 5e7c6bb783
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-04-09 12:18:23 +02:00
Jacopo Bartiromo b839cf3419
Minor changes to Traffic Manager (#2708)
* removes vertical offset
changes in radius
radius increasing with higher velocity

* changes to collision detection policy

* introducing radius as parameter
removed radius increasing with velocity
2020-04-09 09:56:04 +02:00
berndgassmann 53967647ed
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-04-08 16:00:03 +02:00
Praveen Kumar 30edd5ce2c Implemented changes to track multiple hero vehicles
in hybrid physics mode.
2020-04-08 15:45:52 +02:00
berndgassmann f02c269bd1
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-04-08 14:55:41 +02:00
Praveen Kumar 8c7ac56f8f Implemented changes to account for corners
of unregistered vehicles during localization.
2020-04-08 14:26:34 +02:00
berndgassmann cf413fa8b4
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-04-07 17:05:32 +02:00
Néstor Subirón 499b189fe7 Fix compilation issue with BullseyeCoverage 2020-04-06 17:40:25 +02:00
berndgassmann 07fafaea67
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-04-02 19:59:17 +02:00
Axel1092 bdd0aaaac9 Added function to retrieve landmarks in the same group. 2020-04-02 19:01:31 +02:00
Axel1092 e24bcebfbf Added get landmarks functions from map. 2020-04-02 19:01:31 +02:00
Bernd Gassmann 938c4516ae Added detailed documentation of RSSSensor 2020-04-01 11:51:33 +02:00
berndgassmann 5743930238
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-04-01 08:25:14 +02:00
Praveen Kumar fe86dc21d1 Changed ApplyBatchSync call by passing do_tick_cue=true
to reduce longitudinal oscillation in hybrid physics mode.
2020-03-31 23:04:04 +02:00
Praveen Kumar 58c7fe3539 Implemented waiting trigger in localization stage
to initiate pipeline in synchronous mode.

Restricting teleportation to forward direction only
by checking teleportation transform in batch control stage.
2020-03-31 23:04:04 +02:00
Bernd Gassmann 179ec725fa Fix some robustness issues
Create RssCheck (again) when Listen is called to prevent from creating
loggers all the time someone lopps over the actor list and the
actor/sensor instances getting created.

Only traverse actor list in CreateWorldModel once.

tbb::parallel_for_each() gets already created actors and doesn't loop
itself over actor list (which blocks).

Finally changed code format of RSS to keep 120 chars per line.
2020-03-31 18:30:50 +02:00
berndgassmann 849a6c54c5
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-03-31 18:28:22 +02:00
Praveen Kumar 858a58556f
Hot Fixes For Hybrid Physics Mode (#2680)
* Improved braking, collision negotiation.

* Improved braking algorithm for smoother approach
to lead vehicle.

* Implemented smoother path boundary modification
to aid smoother braking.

* Re-worked collision negotiation algorithm.

* Improved collision candidate filtering.

* Added safe-guard in case of vehicle removal
in collision stage.

* Used local variable for heavily referenced object
in localization stage.

* Implemented vector relative velocities
for motion planner's collision consideration.

* Moved collision candidate sorting logic
from collision stage to localization stage.

* Sorting collision candidates using their ids
instead of shared pointers to avoid memory corruption.

* Improved conditions for collision consideration
for greater efficiency.

* Removed fps limit in async mode.

* Hybrid physics mode

* Introduced hybrid physics mode parameter
* Implemented physics independent velocity computation
* Modified localization stage to be physics agnostic

* Fixing velocity compute interval in sync and async mode.
Made motion planner stage work with internally computed velocities.

* Made collision stage agnostic to actor physics

* Sampling waypoint buffer for teleportation window

* WIP: Teleportation changes

* WIP2: Teleportation changes

* Fixes waypoint window and vehicle spawning

* hotfix to performance benchmark

* comment out debugs

* changelog

* fixes collision bug

* fixes package error and out_of_range bug

* WIP: Hybrid mode oscillation bug

* Added vertical offset parameter for physics-less mode.
Restricting longitudinal waypoint offset to forward only.

* remove comment

Co-authored-by: Jacopo Bartiromo <jackbart94@gmail.com>
Co-authored-by: Jacopo Bartiromo <32928804+jackbart94@users.noreply.github.com>
2020-03-31 14:56:18 +02:00
Axel1092 1e06309953 Added warning when signals overlap driving lanes. 2020-03-31 12:12:02 +02:00
Marc Garcia Puig 0eed245e34 Review fixes 2020-03-31 12:11:39 +02:00
Marc Garcia Puig 5520f31d0a Exposed road mesh generation params to PythonAPI 2020-03-31 12:11:39 +02:00
Marc Garcia Puig b94180b0ce Fixed wall generation 2020-03-31 12:11:39 +02:00
Marc Garcia Puig 0999b0ba05 Added basic walls to standalone OpenDRIVE mode 2020-03-31 12:11:39 +02:00
berndgassmann dc6c80a820
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-03-31 10:28:35 +02:00
Jacopo Bartiromo 151e38ce8d
Hybrid mode for Traffic Manager (#2674)
* Improved braking, collision negotiation.

* Improved braking algorithm for smoother approach
to lead vehicle.

* Implemented smoother path boundary modification
to aid smoother braking.

* Re-worked collision negotiation algorithm.

* Improved collision candidate filtering.

* Added safe-guard in case of vehicle removal
in collision stage.

* Used local variable for heavily referenced object
in localization stage.

* Implemented vector relative velocities
for motion planner's collision consideration.

* Moved collision candidate sorting logic
from collision stage to localization stage.

* Sorting collision candidates using their ids
instead of shared pointers to avoid memory corruption.

* Improved conditions for collision consideration
for greater efficiency.

* Removed fps limit in async mode.

* Hybrid physics mode

* Introduced hybrid physics mode parameter
* Implemented physics independent velocity computation
* Modified localization stage to be physics agnostic

* Fixing velocity compute interval in sync and async mode.
Made motion planner stage work with internally computed velocities.

* Made collision stage agnostic to actor physics

* Sampling waypoint buffer for teleportation window

* WIP: Teleportation changes

* WIP2: Teleportation changes

* Fixes waypoint window and vehicle spawning

* hotfix to performance benchmark

* comment out debugs

* changelog

* fixes collision bug

* fixes package error and out_of_range bug

* changes after review

* Left & Right Transit of a lane: Waypoint mapping

Co-authored-by: Praveen Kumar <pravinblaze@hotmail.com>
Co-authored-by: Soumyadeep <soumyadeep.dhar@kpit.com>
2020-03-30 22:53:29 +02:00
doterop 081de023ce Added methods to get trafficlights and trafficsigns from landmarks 2020-03-30 19:44:46 +02:00
berndgassmann 5dda249040
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-03-30 17:49:15 +02:00
Axel1092 1b108a027c Review fixes. Added default lane validity if missing record in OpenDRIVE. Added Automatic spawn of traffic lights and signals to the map generation without geometry. 2020-03-30 14:40:39 +02:00
Axel1092 df75abf5bf Added stop sign automatic triggerbox generation. 2020-03-30 14:40:39 +02:00
Axel1092 d2b9c7e11f Added computation of conflicting road in junctions. 2020-03-30 14:40:39 +02:00
berndgassmann ee5c7c8c42
Merge branch 'master' into feature/integrate_rss_3.0.0 2020-03-30 09:46:50 +02:00
Praveen Kumar a075e4fc5c
Collision avoidance and braking improvements (#2650)
* Improved braking, collision negotiation.

* Improved braking algorithm for smoother approach
to lead vehicle.

* Implemented smoother path boundary modification
to aid smoother braking.

* Re-worked collision negotiation algorithm.

* Improved collision candidate filtering.

* Added safe-guard in case of vehicle removal
in collision stage.

* Used local variable for heavily referenced object
in localization stage.

* Implemented vector relative velocities
for motion planner's collision consideration.

* Moved collision candidate sorting logic
from collision stage to localization stage.

* Sorting collision candidates using their ids
instead of shared pointers to avoid memory corruption.

* Improved conditions for collision consideration
for greater efficiency.

* Removed fps limit in async mode.

* removed unused variable e

* Implemented more details in snippet profiler
Demonstration of compute bottleneck demo

* Deeper bottleneck investigation demo

* * Implemented road curvature threshold for path polygon
vertex selection
* Implemented direct boost point append to construct polygons

* * Fix for polygon shrink bug.
* Changed polygon start point relative to front waypoint
instead of vehicle location.
* Removed debug statements

* Implemented lock and track logic for collision avoidance
instead of state-less boundary extension.

Improved braking logic to approach moving lead vehicle
until a threshold and then following it at distance.

* Increased vertical overlap threshold
to accomodate high slope roads.

* Implemented PR review change

* Fixed collision negotiation bug inside junctions.

* Implemented speed dependent (linear) follow distance.

Temporary solution to flush overcompensating controller state.

* Clamped velocity integral to avoid accumulating
over-compensation for vehicles that take
a long time to reach high target velocities.

* changes to pid values
changes to collision stage conditions

Co-authored-by: Jacopo Bartiromo <jackbart94@gmail.com>
Co-authored-by: Jacopo Bartiromo <32928804+jackbart94@users.noreply.github.com>
Co-authored-by: bernat <bernatx@gmail.com>
2020-03-28 16:26:50 +01:00