Control system fault diagnosis and fault tolerance control