Fixed small bug in forward kinematics block for left foot and fixed EEWrench blocks missing param