In one embodiment, a micro-electro-mechanical-system (MEMS) photonic switch includes a first plurality of collimators including a first collimator configured to receive a first traffic optical beam having a traffic wavelength and a first control optical beam having a control wavelength, where a first focal length of the first collimators at the traffic wavelength is different than a second focal length of the first collimators at the control wavelength. The MEMS photonic switch also includes a first mirror array optically coupled to the first plurality of collimators, where the first mirror array including a first plurality of first MEMS mirrors integrated on a first substrate and a first plurality of first photodiodes integrated on the first substrate, where the photodiodes are disposed in interstitial spaces between the MEMS mirrors.