Velocity Estimation by using Imperfect Accelerometer and Encoder for Rigid Contact Modeling and Control