Update AS5040.cpp

started adding code for actual hardware interfacing