[Feature] adding get-pos LispBM feature

[totosolat]

Hi,

This code adds the (get-pos) command. This feature is useful when performing custom position control and/or impedence control.