Formation control and decentralized estimation