TDMA code OK, but timing issues to fix