aaa
Dependencies: mbed BNO055_fusion Adafruit_GFX ros_lib_kinetic
myOled.h@4:cf1a4e503974, 2018-12-12 (annotated)
- 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?
User | Revision | Line number | New 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 |