Fixed the inverted motor problem for 6-axis