Add DistanceSensor controller and many bugfixed.