A Two-Color Heterodyne Interferometer Based on Diffraction Grating for Displacement Measurement