Self-Organization and Topology Control of Infrastructure Sensor Networks