Fixed normalizeangle, added macro for for every element