Smooth servo movements

That won't work. Every accelerometer is noisy. I suggest to start with the Kalman Guide.