Three-Dimensional Terahertz Imaging Based on Piecewise Constant Doppler Algorithm and Step-Frequency Continuous-Wave Signalling