add aria-minjerk-interpolator.l, sub joint_states commnad and pub position and torque command to aria