on going work, prepare for F<double>
optim finished, i hope | later : get the code better and smaller
fix bug in optim, add env loading
modify DTD but not implemented in code yet
add init and final velocity, fix bug and on going work
modif bound optim
update save to reload the motion
merge