fixed size bug in kalman_filter_initialize_uc()