Revision 1:6179c2d67d19, committed 2019-03-18

Comitter:

ellisbhastroud

Date:

Mon Mar 18 11:02:06 2019 +0000

Parent:

0:c6ceddb241df

Child:

2:81cfa8310f55

Commit message:

Menu Added

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/FXOS8700CQ/FXOS8700CQ.cpp	Mon Mar 18 11:02:06 2019 +0000
@@ -0,0 +1,185 @@
+/* FXOS8700CQ Library
+
+Sample code from ELEC2645 - demonstrates how to create a library
+for the K64F on-board accelerometer and magnetometer
+
+(c) Craig A. Evans, University of Leeds, Jan 2017
+
+*/ 
+
+#include "FXOS8700CQ.h"
+
+// constructor is called when the object is created - use it to set pins and frequency
+FXOS8700CQ::FXOS8700CQ(PinName sda, PinName scl)
+{
+    i2c = new I2C(sda,scl);        // create new I2C instance and initialise
+}
+
+// destructor is called when the object goes out of scope
+FXOS8700CQ::~FXOS8700CQ()
+{
+    delete i2c;        // free memory
+}
+
+// based on 13.4 in datasheet - 200 Hz hybrid mode (both acc and mag)
+void FXOS8700CQ::init()
+{
+    // i2c fast-mode - 10.1.1 data sheet
+    i2c->frequency(400000);       // I2C Fast Mode - 400kHz
+
+    // the device has an ID number so we check the value to ensure the correct
+    // drive is on the i2c bus
+    char data = read_byte_from_reg(FXOS8700CQ_WHO_AM_I);
+    if (data != FXOS8700CQ_WHO_AM_I_VAL) { // if correct ID not found, hang and flash error message
+        error("Incorrect ID!");
+    }
+
+    // write 0000 0000 = 0x00 to accelerometer control register 1 to place
+    // FXOS8700CQ into standby
+    // [7-1] = 0000 000
+    // [0]: active=0
+    data = 0x00;
+    send_byte_to_reg(data,FXOS8700CQ_CTRL_REG1);
+
+    // write 0001 1111 = 0x1F to magnetometer control register 1
+    // [7]: m_acal=0: auto calibration disabled
+    // [6]: m_rst=0: no one-shot magnetic reset
+    // [5]: m_ost=0: no one-shot magnetic measurement
+    // [4-2]: m_os=111=7: 8x oversampling (for 200Hz) to reduce magnetometer noise
+    // [1-0]: m_hms=11=3: select hybrid mode with accel and magnetometer active
+    data = 0x1F;
+    send_byte_to_reg(data,FXOS8700CQ_M_CTRL_REG1);
+
+    // write 0010 0000 = 0x20 to magnetometer control register 2
+    // [7]: reserved
+    // [6]: reserved
+    // [5]: hyb_autoinc_mode=1 to map the magnetometer registers to follow
+    // the accelerometer registers
+    // [4]: m_maxmin_dis=0 to retain default min/max latching even though not used
+    // [3]: m_maxmin_dis_ths=0
+    // [2]: m_maxmin_rst=0
+    // [1-0]: m_rst_cnt=00 to enable magnetic reset each cycle
+    data = 0x20;
+    send_byte_to_reg(data,FXOS8700CQ_M_CTRL_REG2);
+
+    // write 0000 0001= 0x01 to XYZ_DATA_CFG register
+    // [7]: reserved
+    // [6]: reserved
+    // [5]: reserved
+    // [4]: hpf_out=0
+    // [3]: reserved
+    // [2]: reserved
+    // [1-0]: fs=01 for accelerometer range of +/-4g range with 0.488mg/LSB
+    data = 0x01;
+    send_byte_to_reg(data,FXOS8700CQ_XYZ_DATA_CFG);
+
+    // write 0000 1101 = 0x0D to accelerometer control register 1
+    // [7-6]: aslp_rate=00
+    // [5-3]: dr=001 for 200Hz data rate (when in hybrid mode)
+    // [2]: lnoise=1 for low noise mode
+    // [1]: f_read=0 for normal 16 bit reads
+    // [0]: active=1 to take the part out of standby and enable sampling
+    data = 0x0D;
+    send_byte_to_reg(data,FXOS8700CQ_CTRL_REG1);
+
+}
+
+Data FXOS8700CQ::get_values()
+{
+    // 13 bytes - status plus 6 channels (2 bytes each)
+    // x,y,z for accelerometer and magnetometer
+    char data[FXOS8700CQ_READ_LEN];
+    read_bytes_from_reg(FXOS8700CQ_STATUS,FXOS8700CQ_READ_LEN,data);
+
+    // copy the 14 bit accelerometer byte data into 16 bit words
+    int acc_x = (int16_t)(((data[1] << 8) | data[2]))>> 2;
+    int acc_y = (int16_t)(((data[3] << 8) | data[4]))>> 2;
+    int acc_z = (int16_t)(((data[5] << 8) | data[6]))>> 2;
+
+    // copy the magnetometer byte data into 16 bit words
+    int mag_x = (int16_t) (data[7] << 8) | data[8];
+    int mag_y = (int16_t) (data[9] << 8) | data[10];
+    int mag_z = (int16_t) (data[11] << 8) | data[12];
+
+    Data values;  // struct to hold values
+
+    // 0.488 mg/LSB in 4 g mode (8.1 data sheet)
+    values.ax = 0.488e-3*acc_x;
+    values.ay = 0.488e-3*acc_y;
+    values.az = 0.488e-3*acc_z;
+
+    // the magnetometer sensitivity is fixed at 0.1 μT/LSB
+    values.mx = 0.1e-6*mag_x;
+    values.my = 0.1e-6*mag_y;
+    values.mz = 0.1e-6*mag_z;
+
+    return values;
+}
+
+float FXOS8700CQ::get_pitch_angle() {
+    
+    float pitch;
+    Data values = get_values();
+    // calculate pitch
+    float y = -1.0*values.ax;
+    float x = sqrt(pow(values.ay,2)+pow(values.az,2));
+    pitch = atan2(y,x)*(180.0/3.141592653589793238463);
+    
+    return pitch;
+
+    }
+
+float FXOS8700CQ::get_roll_angle() {
+    
+    float roll;
+    Data values = get_values();
+    // calculate roll angle and convert to deg
+    roll = atan2(values.ay,values.az)*(180.0/3.141592653589793238463);
+
+    return roll;
+    }
+
+void FXOS8700CQ::send_byte_to_reg(char byte,char reg)
+{
+    char data[2];
+    data[0] = reg;
+    data[1] = byte;
+    // send the register address, followed by the data
+    int nack = i2c->write(FXOS8700CQ_ADDR,data,2);
+    if (nack)
+        error("No acknowledgement received!");  // if we don't receive acknowledgement, send error message
+
+}
+
+// reads a byte from a specific register
+char FXOS8700CQ::read_byte_from_reg(char reg)
+{
+    int nack = i2c->write(FXOS8700CQ_ADDR,&reg,1,true);  // send the register address to the slave
+    // true as need to send repeated start condition (5.10.1 datasheet)
+    // http://www.i2c-bus.org/repeated-start-condition/
+    if (nack)
+        error("No acknowledgement received!");  // if we don't receive acknowledgement, send error message
+
+    char rx;
+    nack = i2c->read(FXOS8700CQ_ADDR,&rx,1);  // read a byte from the register and store in buffer
+    if (nack)
+        error("No acknowledgement received!");  // if we don't receive acknowledgement, send error message
+
+    return rx;
+}
+
+// reads a series of bytes, starting from a specific register
+void FXOS8700CQ::read_bytes_from_reg(char reg,int number_of_bytes,char bytes[])
+{
+    int nack = i2c->write(FXOS8700CQ_ADDR,&reg,1,true);  // send the slave write address and the configuration register address
+    // true as need to send repeated start condition (5.10.1 datasheet)
+    // http://www.i2c-bus.org/repeated-start-condition/
+
+    if (nack)
+        error("No acknowledgement received!");  // if we don't receive acknowledgement, send error message
+
+    nack = i2c->read(FXOS8700CQ_ADDR,bytes,number_of_bytes);  // read bytes
+    if (nack)
+        error("No acknowledgement received!");  // if we don't receive acknowledgement, send error message
+
+}
\ No newline at end of file

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/FXOS8700CQ/FXOS8700CQ.h	Mon Mar 18 11:02:06 2019 +0000
@@ -0,0 +1,87 @@
+/** @file FXOS8700CQ.h
+
+@ brief FXOS8700CQ Library
+
+@author Dr Craig A. Evans
+@brief (c) University of Leeds, Jan 2017
+
+@code
+
+#include "mbed.h"
+#include "FXOS8700CQ.h"
+
+// create object and specifiy pins
+FXOS8700CQ device(I2C_SDA,I2C_SCL);
+
+int main()
+{
+    // call initialisation method
+    device.init();
+
+    while (1) {
+        
+        // poll the sensor and get the values, storing in a struct
+        Data values = device.get_values();
+        
+        // print each struct member over serial
+        printf("ax = %f ay = %f az = %f | mx = %f my = %f mz = %f\n"
+               ,values.ax, values.ay, values.az
+               ,values.mx, values.my, values.mz);
+        
+        wait(0.5);
+    }
+}
+
+@endcode
+
+*/
+
+#ifndef FXOS8700CQ_H
+#define FXOS8700CQ_H
+
+#include "mbed.h"
+
+// mbed API uses 8-bit addresses so need to left-shift 7-bit addresses by 1
+#define FXOS8700CQ_ADDR   (0x1D << 1)    // for K64F board
+// values from 13.2 datasheet
+#define FXOS8700CQ_STATUS 0x00
+#define FXOS8700CQ_WHO_AM_I 0x0D
+#define FXOS8700CQ_XYZ_DATA_CFG 0x0E
+#define FXOS8700CQ_CTRL_REG1 0x2A
+#define FXOS8700CQ_M_CTRL_REG1 0x5B
+#define FXOS8700CQ_M_CTRL_REG2 0x5C
+#define FXOS8700CQ_WHO_AM_I_VAL 0xC7
+#define FXOS8700CQ_READ_LEN 13
+
+#define PI 3.14159265359f
+#define RAD2DEG 57.2957795131f
+
+struct Data {
+    float ax;
+    float ay;
+    float az;
+    float mx;
+    float my;
+    float mz;
+};
+
+class FXOS8700CQ
+{
+
+public:
+    FXOS8700CQ(PinName sda, PinName scl);
+    ~FXOS8700CQ();
+    void init();
+    Data get_values();
+    float get_pitch_angle();
+    float get_roll_angle();
+
+private:
+    I2C* i2c;
+
+    void send_byte_to_reg(char byte,char reg);
+    char read_byte_from_reg(char reg);
+    void read_bytes_from_reg(char reg,int number_of_bytes,char bytes[]);
+};
+
+#endif
\ No newline at end of file

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Menu/Menu.cpp	Mon Mar 18 11:02:06 2019 +0000
@@ -0,0 +1,41 @@
+#include "Menu.h"
+
+// constructor
+
+Menu::Menu()
+{
+
+}
+
+//deconstructor
+
+Menu::~Menu()
+{
+
+}
+
+//public methods
+
+void Menu::print_welcome(N5110 &lcd)
+{
+    lcd.clear();
+    lcd.printString("Welcome to",0,0);
+    lcd.printString("GAME",0,1);
+    lcd.printString("by",0,2);
+    lcd.printString("Ellis Blackford Stroud",0,3);
+    lcd.refresh();
+}
+
+void Menu::print_menu(N5110 &lcd)
+{
+    lcd.clear();
+    lcd.printString("Use joystick",0,0);
+    lcd.printString("to select",0,1);
+    lcd.printString("Start Game",0,2);
+    lcd.printString("Highscores",0,3);
+    lcd.printString("Settings",0,4);
+    lcd.refresh();
+}
+
+
+//private methods

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Menu/Menu.h	Mon Mar 18 11:02:06 2019 +0000
@@ -0,0 +1,41 @@
+#ifndef MENU_H
+#define MENU_H
+
+#include "mbed.h"
+#include "N5110.h"
+#include "Gamepad.h"
+
+/** Enum for menu options */
+enum MenuChoices {
+    Start,  /**< Begin Game */
+    Highscores,       /**< View Highscores */
+    Settings,      /**< View Settings */
+};
+
+/** Menu Class
+* @brief Library for controlling menu options
+* @author Ellis Blackford Stroud
+* @date May, 2018
+*/
+
+class Menu {
+
+public:
+
+    /** Constructor */
+    Menu();
+
+    /** Destructor */
+    ~Menu();
+    
+    /** Prints opening message */
+    void print_welcome(N5110 &lcd);
+    
+    /** Prints menu screen */
+    void print_menu(N5110 &lcd);
+    
+private:
+
+};
+
+#endif
\ No newline at end of file

--- a/main.cpp	Tue Mar 12 14:38:03 2019 +0000
+++ b/main.cpp	Mon Mar 18 11:02:06 2019 +0000
@@ -5,18 +5,27 @@
 Name: Ellis Blackford Stroud
 Username: el17ebs
 Student ID Number: 201155309
-Date: 12/03/19
+Date: 09/05/19
 */
 #include "mbed.h"
+#include "Gamepad.h"
+#include "N5110.h"
+#include "Menu.h"
 
-DigitalOut gpo(D0);
-DigitalOut led(LED_RED);
+// objects 
+N5110 lcd(PTC9,PTC0,PTC7,PTD2,PTD1,PTC11);
+Gamepad pad;
 
 int main()
 {
-    while (true) {
-        gpo = !gpo; // toggle pin
-        led = !led; // toggle led
-        wait(0.2f);
-    }
-}
\ No newline at end of file
+    init();
+    print_welcome();
+    wait(3);
+    print_menu();
+}
+
+void init()
+{
+    lcd.init();
+    pad.init();
+}