modified 2014-11-19 changing zero position of 3 and 4 joint