I'm sure it would I'm not the best writer I was going to post how it worked. I thought it wasn't doing the math with my first code but Jerry said it was giving the right results in mpsim.
So what was happening was I was using a float when i output to the lcd it rounded it off. The block of code in post 3 fixed that.