using one argument version of Pose and two argument version of Twist; The former works fine and computes everything correctly; There are still some problems with the latter