change maths in ss_closed_loop_quantization_error() to be state feedback

[polgreen]

Maths should now be: for (i=0; i<K_size; i++) { input = ref - Kstates output = C states + D input states = A states + B * input }