Binary Heaps in Matlab

I am trying to code a robot's solution path in Matlab using Binary Heaps and queues. If anyone can help, I will post the problem.

[Alexandra Harkai]

We don't know what your problem is.

[Jan]

Let me encourage you to post the problem. Otherwise it is imüpossible to estimate if help is possible.

[Walter Roberson]

What is the question?

Note: because functions must occur at the end, anything after function cal_area_classroom should go into a different comment.