Lego break when collide

[anhtuduong]

When stacking lego on top of each other, they break apart. One way to solve is to update static value of the lego in runtime.

[anhtuduong]

A functionality GazeboCommand has been implemented to manipulate static value of model. However it is not accurate!

[anhtuduong]

• Failed to set static of a model in runtime.
• Attempting to create a connection link between models to attach them together.