Removed accelerometer from control loop, found transfer function