Re-tested and fixed new problems in Linux (non-ROS).