Step of previous FootstepDataListMessage gets repeated.

[Martin Oehler]

We are currently working on sending new footsteps to the robot while walking. The way this happens is that 4 footsteps are created. Then after each step (status == 1) a new footstep is appended. Since the footstep controller does not append steps by itself, we tell it to stop, create a new FootStepDataListMessage and send it to the robot.

Most of the time this approach works fine, but on rare occasions the first step after a stop is not the first step of the new message but the last step before the stop. So this step is repeated, even though it isn't part of the new footstep list.

[DouglasS]

@Martin_Oehler This is definitely a bug. If we decide to incorporate improvement #11 then this will be obviated but it is definitely something we should look in to. Thanks for the bug report.