Fix backlash issues

Moved where the backlash is calculated so that it isn't a cycle late