add robot object with heading and rotate support, and tests