Added position update in Moves and Jogs
Added CG command output
Merge changes from gordon