Added inverse-kinematic solver (arm extension still approximate) and separated
teleop geometry from a twist-based driver