Added debug info for time required to get links from database when planning
Added debug info for time required to get links from database when planning

markusgrotz/rtabmap,chen0510566/rtabmap,markusgrotz/rtabmap,chen0510566/rtabmap,markusgrotz/rtabmap,srmanikandasriram/rtabmap,srmanikandasriram/rtabmap,chen0510566/rtabmap,srmanikandasriram/rtabmap