First version of the final algorithm.
Return routines after extinguishing fire PENDING, adjustments to be made upon entering each room to get the best angle PENDING.