Copying M02 from SparkFun lib