////////////////////////////////////////////////////////////////////////////////
// Name:       CMPS03                                                         //
//             Compass legacy                                                 //
// Platform:   Arduino Uno R3                                                 //
// Created by: HARB, rboek2@gmail.com, May 2016, GPL copyrights               //
// http://uwvervoerder.nl/robotigs/includes/parts_header.php?idpart-208       //
// Read the CMPS03 with TWI and display the result on the Serial Monitor.     //
////////////////////////////////////////////////////////////////////////////////

// SET PRECOMPILER OPTIONS *****************************************************
// Define precompiler settings PINS --------------------------------------------

///Define the needed header files for the precompiler, no charge if not used ---
#include <Wire.h>

// Define variables ------------------------------------------------------------
bool ledBinVal = LOW;         //You can chose HIGH-on or LOW-off for LED_BUILTIN
int  twiAdr = 0xC0;         //This is the TWI-address of the connected TWI slave
int  twiQuirk = twiAdr / 2;   //Quirk in the library Wire.h requires this action
int  reading = 0;              //The 2 byte result of the measurement in degrees
//END OF PRECOMPILER OPTIONS ---------------------------------------------------

  
void setup() { //Setup runs once ***********************************************
  Serial.begin(9600);   //Nothing more needed for the Serial Monitor to function
  pinMode(LED_BUILTIN, OUTPUT);          //Arduino boards contain an onboard LED
  Wire.begin();                         //Start i2c bus, no address to be master
}//--(end setup )---------------------------------------------------------------

void loop() { //KEEP ON RUNNING THIS LOOP FOREVER ******************************
  proces_compass();                                  //Read and show data CMPS03
  toggle_ledBin();                  //Toggles the default on-board LED on or off
} //End of void loop()                       //KEEP ON RUNNING THIS LOOP FOREVER
//345678911234567892123456789312345678941234567895123456789612345678971234567898


void proces_compass(void) { //Read and show data CMPS03 ************************
  Wire.beginTransmission(twiQuirk);  //Start to occupy twi-bus and select device
  Wire.write(byte(0x02));   //Sets pointer to the point we want to start reading
  Wire.endTransmission(false);  //Stop transmitting, but do not free the TWI-bus

  Wire.requestFrom(twiQuirk, 2);             //Request 2 bytes from slave device
  while (Wire.available() < 2);   //If two bytes are received, both are buffered
  reading = Wire.read();           //Read high byte, overwrites previous reading
  reading = reading << 8;                    //Shift high byte to be high 8 bits
  reading |= Wire.read();                     //Receive low byte as lower 8 bits
  
  reading = reading / 10;                                //Adapt to full degrees
  Serial.print("Bearing:");                                          //Show text
  Serial.print(reading);                                    // print the reading
  Serial.println(" degree");                                // print the reading
  delay(100);
} //Exit proces_SRF(void) Read and show data Sonar Range Finder ----------------



void toggle_ledBin(void) { //Toggles the default on-board LED on or off ********
  ledBinVal = !ledBinVal;                                         //Toggle value
  digitalWrite(LED_BUILTIN, ledBinVal);         //Set Arduino boards onboard LED
} //Exit toggle_ledBin ---------------------------------------------------------


////////////////////////////////////////////////////////////////////////////////
// PIN ALLOCATIONS TABLE ARDUINO UNO                                          //
// Board -Atmel- PIN - IDE - Function          - Connection               ALT //
//                                                                            //
// CONNECTIONS RAILS TOP LEFT: DIGITAL PWM<~> ******************************* //
// SCL   -  28 - PC5 -19/A5- ADC5/SCL/PCINT13  - White cable to SRF-10    TWI //
// SDA   -  27 - PC4 -18/A4- ADC4/SDA/PCINT12  - Yellow cable to SRF-10   TWI //
// AREF  -  21 - REF -     - AREF              -                              //
// GND   -  22 - GND -     - GND               -                              //
// 13    -  19 - PB5 -  13 - SCK/PCINT5        - LED_BUILTIN Arduino      SPI //
// 12    -  18 - PB4 -  12 - MISO/PCINT4       -                          SPI //
// ~11   -  17 - PB3 -  11 - MOSI/OC2A/PCINT3  -                          PWM //
// ~10   -  16 - PB2 -  10 - SS/OC1B/PCINT2    -                          PWM //
// ~9    -  15 - PB1 -   9 - OC1A/PCINT1       -                          PWM //
// 8     -  14 - PB0 -   8 - PCINT0/CLK0/ICP1  -                          DIO //
//                                                                            //
// CONNECTIONS RAILS TOP RIGHT: DIGITAL PWM<~> ****************************** //
// 7     -  13 - PD7 -   7 - PCINT23/AIN1      -                          DIO //
// ~6    -  12 - PD6 -   6 - PCINT22/OCA0/AIN0 -                          PWM //
// ~5    -  11 - PD5 -   5 - PCINT21/OC0B/T1   -                          PWM //
// ~4    -   6 - PD4 -   4 - PCINT20/XCK/T0    -                          PWM //
// ~3    -   5 - PD3 -   3 - PCINT19/OC2B/INT1 -                          INT //
// ~2    -   4 - PD2 -   2 - PCINT18/INT0      -                          INT //
// TX->1 -   3 - PD1 -   1 - PCINT17/TXD       - Serial monitor           TXD //
// RX<-0 -   2 - PD0 -   0 - PCINT16/RCD       - Serial Monitor           RCD //
//                                                                            //
// CONNECTIONS RAILS BOTTOM LEFT: POWER ************************************* //
// 5V    -   7 - VCC -      - VCC              - Output to breadboard     VCC //
// RES   -   1 - RES -      - PCINT14/RESET    -                          RES //
// 3.3V  -     -     -     -                   -                              //
// 5V    -     -     -     -                   -                              //
// GND   -     -     -     -                   -                              //
// GND   -     -     -     -                   -                              //
// Vin   -     -     -     -                   -                              //
//                                                                            //
// CONNECTIONS RAILS BOTTOM RIGHT: ANALOG IN ******************************** //
// A0    -  23 - PC0 -A0/14- ADC0/PCINT8       -                          ADC //
// A1    -  24 - PC1 -A1/15- ADC1/PCINT9       -                          ADC //
// A2    -  25 - PC2 -A2/16- ADC2/PCINT10      -                          ADC //
// A3    -  26 - PC3 -A3/17- ADC3/PCINT12      -                          ADC //
// A4    -  27 - PC4 -A4/18- ADC4/SDA/PCINT12  -                          TWI //
// A5    -  28 - PC5 -A5/19- ADC5/SCL/PCINT13  -                          TWI //
////////////////////////////////////////////////////////////////////////////////
// EEPROM MEMORY MAP:                                                         //
// Start End  Number Description                                              //
// 0000  0000      1 Never use this memory location to be AVR compatible      //
////////////////////////////////////////////////////////////////////////////////
//345678911234567892123456789312345678941234567895123456789612345678971234567898