Issue when sending 0 goal positions as first goal after startup

[SammyRamone]

See bit-bots/bitbots_lowlevel#113 (comment) point 2.
Needs to be investigated if this is also an issue in the ROS2 version. If this is the case, we should fix it with some flag that handles the first write differently. Maybe it is necessary to write the goal position first before velocity etc for the initilization.

Expected behavior

Current behavior

Steps to Reproduce

...

Context (Environment)

• RViz
• Simulator
• Robot
• Local

Possible Solution