A Centralized Planning and Distributed Execution Method for Shape Filling with Homogeneous Mobile Robots