The authors of Where to look first? Behaviour control for fetch-and-carry missions of service robots have not publicly listed the code yet.
Request code directly from the authors:
Get an expert to implement this paper:
(OR if you have code to share with the community, please add it here 😊🙏 )