[choreonoid] Enhance error reporting