Discrete Cosserat approach for soft robot dynamics: A new piece-wise constant strain model with torsion and shears.