Arduino UNO calculations wrong