KRTMI_Titanium2022
Kodingan untuk Sensor CMPS14 membaca nilai sudut Yaw
Dependencies: mbed
Revision 0:3cba187245ff, committed 2022-10-04
- Comitter:
- photonicbabe
- Date:
- Tue Oct 04 10:58:52 2022 +0000
- Commit message:
- Source Code CMPS14(Kompas)
Changed in this revision
| coba_cmps14.cpp | Show annotated file Show diff for this revision Revisions of this file |
| mbed.bld | Show annotated file Show diff for this revision Revisions of this file |
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/coba_cmps14.cpp Tue Oct 04 10:58:52 2022 +0000
@@ -0,0 +1,42 @@
+#include "mbed.h"
+
+#define i2c_address 0x60
+
+int BEARING_Register;
+char bits[2];
+int _byteHigh;
+int _byteLow;
+int bearing;
+
+I2C CMPS(PB_4, PA_8);
+Serial pc(USBTX, USBRX);
+
+int main()
+{
+ BEARING_Register = 0x02;
+ pc.baud(9600);
+ while(1)
+ {
+ CMPS.unlock();
+ CMPS.start();
+ // to indicate an i2c read, shift the 7 bit address up 1 bit and set bit 0 to a 1
+ CMPS.write(i2c_address << 1);
+ int writeResult = CMPS.write(BEARING_Register);
+ if(writeResult != 1)
+ {
+ pc.printf("%d\n", writeResult);
+ return 0;
+ }
+ else
+ {
+ CMPS.stop();
+ CMPS.read(i2c_address <<1, bits, 2);
+ _byteHigh = bits[0];
+ _byteLow = bits[1];
+ bearing = ((_byteHigh<<=8) + _byteLow) / 10;
+ pc.printf("Bearing : %d\n", bearing);
+ }
+ }
+}
+
+
\ No newline at end of file
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Tue Oct 04 10:58:52 2022 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/mbed_official/code/mbed/builds/65be27845400 \ No newline at end of file