VisionSystem_getCOG
Added one ultrasonic sensor