Move screen size

Refactor

Fix IYI computation

Fix horizontal/vertical constants

Use std::array for indexing structure

Fix condition in `fip()`

Set SamplingInfo defaults

Protect usage of `n` when it is `nullptr`

Update changelog

Change sampling info

Sampling info based on init pose found by `fip()`.

Merge branch 'feature/dubins-path'

Update changelog

Remove tmp graph plot for slot planner

Add drivable node guess, use in st5

Rewrite circle with line segments collide method

Rewrite circle with line segment collide method

Return immediately when not drivable

Finish when nothing to steer in opt

Decide to steer forward/backward in st5

Fix repeating cusp in opt

When two nodes are near themselves, do not use both.

Find final path only when goal found

Add detection of node in front of node

Remove high resolution steering

Because 0.01 is too fine for IS_NEAR macro and it caused backward move
for Dubins paths.

Plot car frame with GL

Add 5th steering procedure to RRTBase

`st5` uses Dubin's paths.

Add `dubins` files

Downloaded from https://github.com/AndrewWalker/Dubins-Curves, the
project is under MIT license.

Widen parallel parking scenarios

Start from original goal

The problem is with parallel parking.

Reformat IS_NEAR, add IS_NEAR for goal

Add FP as first node in slot cusps

Use sampling info for setting up the sampling

But comment it for now as the values used in sampling info don't
correspond to needed values.

Update changelog

Use normal distribution in sampling

Reformat

Merge branch 'feature/multiple-interesting'

Update changelog

Add slot edges as segment obstacles

Use firsts FIFO queue in T2 planner

Add firsts, firsts getter

Merge branch 'feature/multiple-goals'

Update changelog

Add goal_found method for two RRTNodes

Update ccost of goal's parents

Goal is last of goals

Connect goals to goal

Merge branch 'feature/angle-parking'

Update changelog

Remove parking slot segment obstacles

Use slot polygon instead.

Fix find init pose for right perp. parking

Update in slot pose for angle backward parking

Add TODO, fix comment

Fix final pose for backward angular parking

Update in slot pose for angle forward parking

Simplify final pose getter for forward parking

Use `poseHeading()` in `getFP()` in `SlotPlanner`

Add pose heading method to SlotPlanner

Merge branch 'feature/forward-perpendicular-parking'

Update changelog

Add find init pose in forward direction method

Add inside slot position for perp. forward parking

Add init pose for forward perpendicular parking

Merge branch 'feature/perpendicular-slotplanner'

Update changelog

Log path when optimized

Add steer to goals section in T2

Fix get position in slot for LEFT parking slot

Add goals to RRTBase

Rewrite perpendicular slot planner

Add list of goals

This list contains all the poses from slot entry point backwards to
first cusp point (of parking slot).

Add pose in perpendicular slot getter

This method returns a pose of perpendicular parking slot from where it
is possible to get out of the slot with full steer to farther corner
side (i.e. right corner for the RIGHT side).

Fix best final pose (FP) getter, add lper slot

Redefine order of slot border nodes

The node closest to init pose is the first.

Add slot debug output

Change guided sampling

Sampling info contains information of bounding box where to sample:
- `x0 - x/2 ... x0 + x/2`
- `y0 - y/2 ... y0 + y/2`
- `h0 - h/2 ... h0 + h/2`

Add middle node getter

First `fip()` then `getSamplingInfo()`

Just reorder methods

Enable plot just scenario

Fallback to scenario when info in traj missing

Comment out fill between

As multiple scenarios are currently considered.

Set slot heading with `satAll()`

Use find init pose with obstacles

Merge branch 'hotfix/0.6.1'

Update changelog (hotfix)

Switch between guided and random sampling

Fix missing declaration

Merge branch 'release/0.6.0'

Update changelog (release)

Update changelog

Merge branch 'feature/refactor'

Merge branch 'feature/trace-random-samples'

Merge branch 'feature/tune-sampling'

Merge branch 'feature/perpendicular-slotplanner'

Add plot trajectory script

Add rotate scenario script

Add perpendicular slot planner proposal

Add trajectory cusp private getter

Add random init position

Add car outer, inner radius

Include obstacles to slot planner