The next step of my small project was an embedding of the ultrasonic sensor to it.

Let me try to make it work with pic16f628a.