Added Magnetometer stuff

Added Magnetometer Registers
Added Magnetometer self-test method