You should add if statement like for example...
|---------repeat forever
||----repeat until hands full
||find nearest stone
||move to stone
||pick up stone
||----
|
||----repeat until hands empty
||move to stone storage
||add to stone storage
||----
|
||----if stone storage full
||move to incinerator
||add to incinerator
_______________________