Problem with arduino maths