Modified arduino code to read data accurately and transmit to APM. Testing pending as of commit.