From: Walter Fetter Lages <w.fetter@ieee.org>
Date: Fri, 1 Feb 2019 07:12:11 +0000 (-0200)
Subject: Change clock source to external.
X-Git-Tag: f1~7
X-Git-Url: http://git.ece.ufrgs.br/?a=commitdiff_plain;h=cbfff5d25008df0dd3cfee4e8b6caa8d10871717;p=bno055.git

Change clock source to external.
---

diff --git a/test/bno055_test.c b/test/bno055_test.c
index e0b815f..db9c382 100644
--- a/test/bno055_test.c
+++ b/test/bno055_test.c
@@ -38,6 +38,8 @@ int main(int argc,char *argv[])
 	
 	s8 temp;
 	double d_temp;
+	u8 stat_clk;
+	u8 clk_src;
 	
 	if(argc < 2) usage_help(argv[0]);
 
@@ -77,6 +79,19 @@ int main(int argc,char *argv[])
 	}
 	else fprintf(stderr,"Error while initializing bno055.\n");
 
+	if(bno055_get_stat_main_clk(&stat_clk) != BNO055_SUCCESS)
+		fprintf(stderr,"Error while reading clock status.\n");
+	else
+	{
+		if(stat_clk==0)
+		{
+			clk_src=1;
+			if(bno055_set_clk_src(clk_src) != BNO055_SUCCESS) fprintf(stderr,"Error while setting clock source.\n");
+			else printf("Clock source changed to external\n");
+		}
+		else printf("Clock source can't be changed.\n");
+	}
+
 	printf("Raw data:\n");
 	if(bno055_set_operation_mode(BNO055_OPERATION_MODE_AMG) != BNO055_SUCCESS)
 		fprintf(stderr,"Error while setting operation mode.\n");
@@ -142,7 +157,7 @@ int main(int argc,char *argv[])
 	else fprintf(stderr,"Error while reading gravity in m/s^2.\n");
 	
 	if(bno055_convert_double_temp_celsius(&d_temp) == BNO055_SUCCESS)
-		printf("Temperature=%G degree Celsius\n",d_temp);
+		printf("Temperature=%G degrees Celsius\n",d_temp);
 	else fprintf(stderr,"Error while reading temperature in degrees Celsius.\n");
 
 	close(fd);