fixed iksolver Solve bug
fixed dual arm demo