[STAPLE/BCS] Feet have wrong BC

[modenaxe]

example with body coordinate system has wrong coordinates for feets. This does not affect results etc but should be fixed

[modenaxe]

quick fix added. Needs testing with multiple datasets