Changing around time slicing in PID 5khz timer, removing some kruft