6502/CLK
1
0
Fork 0
mirror of https://github.com/TomHarte/CLK.git synced 2024-07-07 08:28:57 +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
{
// perform a linear regression
float sum_xy = 0;
float sum_x = 0;
float sum_y = 0;
float sum_x_squared = 0;
int sum_xy = 0;
int sum_x = 0;
int sum_y = 0;
int sum_x_squared = 0;
for(size_t pulse = 0; pulse < _length_of_history; pulse++)
{
int x = _pulse_history_array[pulse] / (int)_current_window_length;
int y = _pulse_history_array[pulse] % (int)_current_window_length;
sum_xy += (float)(x*y);
sum_x += (float)x;
sum_y += (float)y;
sum_x_squared += (float)x*x;
sum_xy += x*y;
sum_x += x;
sum_y += y;
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);
_current_window_length += (unsigned int)(gradient / 2.0);
int gradient = (_length_of_history*sum_xy - sum_x*sum_y) / (_length_of_history*sum_x_squared - sum_x*sum_x);
_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;
}