Lines Matching refs:st
26 void wf_pid_init(struct wf_pid_state *st, struct wf_pid_param *param)
28 memset(st, 0, sizeof(struct wf_pid_state));
29 st->param = *param;
30 st->first = 1;
34 s32 wf_pid_run(struct wf_pid_state *st, s32 new_sample)
38 int i, hlen = st->param.history_len;
41 error = new_sample - st->param.itarget;
44 if (st->first) {
46 st->samples[i] = new_sample;
47 st->errors[i] = error;
49 st->first = 0;
50 st->index = 0;
52 st->index = (st->index + 1) % hlen;
53 st->samples[st->index] = new_sample;
54 st->errors[st->index] = error;
59 integ += st->errors[(st->index + hlen - i) % hlen];
60 integ *= st->param.interval;
63 deriv = st->errors[st->index] -
64 st->errors[(st->index + hlen - 1) % hlen];
65 deriv /= st->param.interval;
68 target = (s32)((integ * (s64)st->param.gr + deriv * (s64)st->param.gd +
69 error * (s64)st->param.gp) >> 36);
70 if (st->param.additive)
71 target += st->target;
72 target = max(target, st->param.min);
73 target = min(target, st->param.max);
74 st->target = target;
76 return st->target;
80 void wf_cpu_pid_init(struct wf_cpu_pid_state *st,
83 memset(st, 0, sizeof(struct wf_cpu_pid_state));
84 st->param = *param;
85 st->first = 1;
89 s32 wf_cpu_pid_run(struct wf_cpu_pid_state *st, s32 new_power, s32 new_temp)
93 int i, hlen = st->param.history_len;
96 error = st->param.pmaxadj - new_power;
99 if (st->first) {
101 st->powers[i] = new_power;
102 st->errors[i] = error;
104 st->temps[0] = st->temps[1] = new_temp;
105 st->first = 0;
106 st->index = st->tindex = 0;
108 st->index = (st->index + 1) % hlen;
109 st->powers[st->index] = new_power;
110 st->errors[st->index] = error;
111 st->tindex = (st->tindex + 1) % 2;
112 st->temps[st->tindex] = new_temp;
117 integ += st->errors[(st->index + hlen - i) % hlen];
118 integ *= st->param.interval;
119 integ *= st->param.gr;
120 sval = st->param.tmax - (s32)(integ >> 20);
121 adj = min(st->param.ttarget, sval);
126 deriv = st->temps[st->tindex] -
127 st->temps[(st->tindex + 2 - 1) % 2];
128 deriv /= st->param.interval;
129 deriv *= st->param.gd;
132 prop = st->last_delta = (new_temp - adj);
133 prop *= st->param.gp;
138 target = st->target + (s32)((deriv + prop) >> 36);
139 target = max(target, st->param.min);
140 target = min(target, st->param.max);
141 st->target = target;
143 return st->target;