corrected the goal pose sending by adding the w component to the pose when sending