I am implementing the UKF filter and in prediction step, I have to calculate the non-linear function g and pass it through the sigma points, input, and time-step. I am stuck