denavit-hartenberg fix