add the reference angular momentum into NLP cost