refactoring nlp
nlp update
Merge branch 'state_with_velocity' of https://github.com/Chpark/itomp.git into state_with_velocity