Have you tried printing out the various values to Serial to make sure they are reading what you expect?