Fixed Added_angle to be correct in drawSTGrayEncoder and moved it outside the loop as it only needs to be calculated once.