Servo control systems are used in a wide range of industrial applications such as robotics, and machine tools. Due to the elastic nature of mechanical linkages and high servo gains mechanical vibration may occurs in servo control systems. These vibrations may introduce velocity and positioning errors and may be harmful to the mechanical components. Therefore, a novel mechanical vibration detection and suppression by notch filter scheme in servo control system is presented in this thesis. The scheme uses velocity error and band pass filters to track resonance frequencies. After the detection a notch filter cascaded to the velocity feedback can be set to suppress the vibration. The theorem and experimental result shows that the proposed scheme can detect and suppress mechanical vibrations effectively.