aaa

Dependencies:   mbed BNO055_fusion Adafruit_GFX ros_lib_kinetic

Committer:
nakedt555
Date:
Wed Dec 12 03:35:52 2018 +0000
Revision:
4:cf1a4e503974
Child:
8:80708bacb5b5
toriaezu ok;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nakedt555 4:cf1a4e503974 1 #ifndef _MY_OLED_H_
nakedt555 4:cf1a4e503974 2 #define _MY_OLED_H_
nakedt555 4:cf1a4e503974 3
nakedt555 4:cf1a4e503974 4 #include "mbed.h"
nakedt555 4:cf1a4e503974 5 #include "Adafruit_SSD1306.h"
nakedt555 4:cf1a4e503974 6 #include "odom.h"
nakedt555 4:cf1a4e503974 7 #include "type.h"
nakedt555 4:cf1a4e503974 8
nakedt555 4:cf1a4e503974 9 class My_Oled : public Odom_Abstract, Adafruit_SSD1306_I2c
nakedt555 4:cf1a4e503974 10 {
nakedt555 4:cf1a4e503974 11 private:
nakedt555 4:cf1a4e503974 12
nakedt555 4:cf1a4e503974 13 public:
nakedt555 4:cf1a4e503974 14 My_Oled(Odom *odom, I2C &i2c) : Odom_Abstract(odom), Adafruit_SSD1306_I2c(i2c, D10){
nakedt555 4:cf1a4e503974 15 clearDisplay();
nakedt555 4:cf1a4e503974 16 }
nakedt555 4:cf1a4e503974 17
nakedt555 4:cf1a4e503974 18 private:
nakedt555 4:cf1a4e503974 19 //Overlap function
nakedt555 4:cf1a4e503974 20 virtual void loop(){
nakedt555 4:cf1a4e503974 21 static uint32_t counter = 0;
nakedt555 4:cf1a4e503974 22 if((++counter % 10) == 0){
nakedt555 4:cf1a4e503974 23 setTextCursor(0,0);
nakedt555 4:cf1a4e503974 24 printf("Court color -> %s\n\n", (get_court_color() ? "BLUE" : "RED"));
nakedt555 4:cf1a4e503974 25 printf("odom x -> %8.4f\n", get_pose().x());
nakedt555 4:cf1a4e503974 26 printf(" y -> %8.4f\n", get_pose().y());
nakedt555 4:cf1a4e503974 27 printf(" a -> %8.4f\n", get_pose().z());
nakedt555 4:cf1a4e503974 28 printf("drift x -> %8.4f\n", get_drift().x());
nakedt555 4:cf1a4e503974 29 printf(" y -> %8.4f\n", get_drift().y());
nakedt555 4:cf1a4e503974 30 printf(" a -> %8.4f\n", get_drift().z());
nakedt555 4:cf1a4e503974 31 display();
nakedt555 4:cf1a4e503974 32 }
nakedt555 4:cf1a4e503974 33 }
nakedt555 4:cf1a4e503974 34
nakedt555 4:cf1a4e503974 35 };
nakedt555 4:cf1a4e503974 36 #endif