Tool radius compensation