What do you need help with?

So, I have an array GoalXZ and I want to go through its points one by one in code.

read baritone api...

Just loop over all y values at the x,z positions of all your goals.