Working encoder speed calculation