發送短信: Simultaneous scene reconstruction and whole-body motion planning for safe operation in dynamic environments