Create AS5040 library test program

Checks all functions of the library