Featherstone algorithm now works