More kalman Tuning. Added Square function.