Trajectory Optimization And Control Of Small Spacecraft Constellations