Rev X1: Added joint position passing and more constant declaration