comparison core/I2c_Codec.cpp @ 134:09a32ca96255

Fixed and improved I2c_codec. Copied from the scope-refactoring branch

 {
 	if(writeRegister(0x02, 0x00))	// Codec sample rate register: fs_ref / 1
 		return 1;
 	if(writeRegister(0x03, 0x91))	// PLL register A: enable
 		return 1;
-	if(writeRegister(0x04, 0x1C))	// PLL register B
-		return 1;
-	if(writeRegister(0x05, 0x52))	// PLL register C
-		return 1;
-	if(writeRegister(0x06, 0x40))	// PLL register D
+//	if(writeRegister(0x04, 0x1C))	// PLL register B
+//		return 1;
+//	if(writeRegister(0x05, 0x52))	// PLL register C
+//		return 1;
+//	if(writeRegister(0x06, 0x40))	// PLL register D
+//		return 1;
+	if(setPllD(5264)) //7.5264 gives 44.1kHz nominal value with a 12MHz master clock
+		return 1;
+	if(setPllJ(7))
 		return 1;
 	if(dual_rate) {
 		if(writeRegister(0x07, 0xEA))	// Codec datapath register: 44.1kHz; dual rate; standard datapath
 			return 1;
 	}

 }
 
 //set the numerator multiplier for the PLL
 int I2c_Codec::setPllK(float k){
 	short unsigned int j=(int)k;
-	unsigned int d=(k-j+0.5)*10000; //fractionary part, between 0 and 9999
+	unsigned int d=(int)(0.5+(k-j)*10000); //fractional part, between 0 and 9999
 	if(setPllJ(j)>0)
 		return 1;
 	if(setPllD(d)>0)
 		return 2;
 	return 0;

 	}
 	if(writeRegister(0x04, j<<2)){	// PLL register B: j<<2
 		printf("I2C error while writing PLL j: %d", j);
 		return 1;
 	}
+	pllJ=j;
 	return 0;
 }
 
 //set fractional part(between 0 and 9999) of the numerator mutliplier of the PLL
 int I2c_Codec::setPllD(unsigned int d){

 	}
 	if(writeRegister(0x06, (d<<2)&255)){	// PLL register D: D=5264, part 2
 		printf("I2C error while writing PLL d part 2 : %d", d);
 		return 1;
 	}
-	return 0;
+	pllD=d;
+	return 0;
+}
+
+int I2c_Codec::setAudioSamplingRate(float newSamplingRate){
+	int pllP=1; //TODO: create get/set for pllP and pllR
+	int pllR=1;
+	long int PLLCLK_IN=12000000;
+	//	f_{S(ref)} = (PLLCLK_IN × K × R)/(2048 × P)
+	float k = ((double)(newSamplingRate * pllP * 2048.0f/(float)pllR)) / PLLCLK_IN ;
+	return (setPllK(k));
+}
+
+short unsigned int I2c_Codec::getPllJ(){
+	return pllJ;
+}
+unsigned int I2c_Codec::getPllD(){
+	return pllD;
+}
+float I2c_Codec::getPllK(){
+	float j=getPllJ();
+	float d=getPllD();
+	float k=j+d/10000.0f;
+	return k;
+}
+
+float I2c_Codec::getAudioSamplingRate(){
+	int pllP=1; //TODO: create get/set for pllP and pllR
+	int pllR=1;
+	long int PLLCLK_IN=12000000;
+	//	f_{S(ref)} = (PLLCLK_IN × K × R)/(2048 × P)
+	float fs = (PLLCLK_IN/2048.0f) * getPllK()*pllR/(float)pllP;
+	return fs;
 }
 // Set the volume of the DAC output
 int I2c_Codec::setDACVolume(int halfDbSteps)
 {
 	dacVolumeHalfDbs = halfDbSteps;