6502/CLK
1
0
Fork 0
mirror of https://github.com/TomHarte/CLK.git synced 2024-07-15 00:29:07 +00:00
Code Issues Projects Releases Wiki Activity

Eliminated floating point arithmetic.

Browse Source
This commit is contained in:
Thomas Harte 2016-07-14 19:47:00 -04:00
parent 6b4fec37ff
commit 6afd619791
1 changed files with 10 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

20
Storage/Disk/DigitalPhaseLockedLoop.cpp
View File

@ -54,23 +54,23 @@ void DigitalPhaseLockedLoop::add_pulse()
else else
{ {
// perform a linear regression // perform a linear regression
float sum_xy = 0; int sum_xy = 0;
float sum_x = 0; int sum_x = 0;
float sum_y = 0; int sum_y = 0;
float sum_x_squared = 0; int sum_x_squared = 0;
for(size_t pulse = 0; pulse < _length_of_history; pulse++) for(size_t pulse = 0; pulse < _length_of_history; pulse++)
{ {
int x = _pulse_history_array[pulse] / (int)_current_window_length; int x = _pulse_history_array[pulse] / (int)_current_window_length;
int y = _pulse_history_array[pulse] % (int)_current_window_length; int y = _pulse_history_array[pulse] % (int)_current_window_length;
sum_xy += (float)(x*y); sum_xy += x*y;
sum_x += (float)x; sum_x += x;
sum_y += (float)y; sum_y += y;
sum_x_squared += (float)x*x; sum_x_squared += x*x;
} }
float gradient = ((float)_length_of_history*sum_xy - sum_x*sum_y) / ((float)_length_of_history*sum_x_squared - sum_x*sum_x); int gradient = (_length_of_history*sum_xy - sum_x*sum_y) / (_length_of_history*sum_x_squared - sum_x*sum_x);
_current_window_length += (unsigned int)(gradient / 2.0); _current_window_length += gradient / 2;
if(_current_window_length < _clocks_per_bit - _tolerance) _current_window_length = _clocks_per_bit - _tolerance; if(_current_window_length < _clocks_per_bit - _tolerance) _current_window_length = _clocks_per_bit - _tolerance;
if(_current_window_length > _clocks_per_bit + _tolerance) _current_window_length = _clocks_per_bit + _tolerance; if(_current_window_length > _clocks_per_bit + _tolerance) _current_window_length = _clocks_per_bit + _tolerance;
} }