CasADi files for 6-dof arm