You can adjust the mass and inertial parameters a bit, that helped for me (my URDF [xacro] is https://github.com/MobileRobots/amr-ros-config/blob/master/description/urdf/pioneer3at.urdf.xacro). A P3AT with three batteries is 21.5 kg. Each wheel with tire is 1.4 kg.