Implemented KalmanGyro::getAccelZangle() and KalmanGyro::getGyroZrate()