Fix setpoints pointer problems

[Roelemans]

Description

There was a bug in #100 that caused a crash when doing lock -> invert -> lock. It had something to do with pointers to setpoints which got messy when start en end point got changed around by invert. Hence, I simply set position and velocity to be equal here, instead of assigning setpoints[0] = start_point etc.

Changes

[codecov]

Codecov Report

Merging #101 into develop will decrease coverage by 0.03%.
The diff coverage is 100.00%.

@@             Coverage Diff             @@
##           develop     #101      +/-   ##
===========================================
- Coverage    72.95%   72.91%   -0.04%     
===========================================
  Files           17       17              
  Lines         1671     1669       -2     
  Branches       186      184       -2     
===========================================
- Hits          1219     1217       -2     
  Misses         404      404              
  Partials        48       48              

Flag	Coverage Δ
#production	55.38% <100.00%> (-0.09%)	⬇️
#test	99.25% <ø> (ø)

Impacted Files	Coverage Δ
...ait_generator/model/modifiable_joint_trajectory.py	91.93% <100.00%> (-0.13%)	⬇️

---

Continue to review full report at Codecov.

Legend - Click here to learn more
Δ = absolute <relative> (impact), ø = not affected, ? = missing data
Powered by Codecov. Last update d624379...cc77338. Read the comment docs.

[Olavhaasie]

Good find 👍