Playback drift - adjusting Desired_fill

As per issue #309 find appropriate code modifications.

Please ignore my debug timestamps and GPIO control as I'm not sure how to exclude them from this pull request.