Fix dynamic_mat_ass_load in contactSLag

Closes #716 (closed)
Alternative to !514 (closed)

dynamic_mat_ass_loadでは、optional引数となっているiterが存在する場合に要素タイプ3414の右辺ベクトルを調整している。
NaNになっていたのは、dynamic_mat_ass_loadのL224-338が無視されたことによると考えられるため修正。