Have tested the order system with rqt-input and checked the topic outputs. It seems to be working properly now.
Merge branch 'master' of https://github.com/rsd9/rsdGroup92013