3D Model-based 6D Object Pose Tracking on RGB Images using Particle Filtering and Heuristic Optimization