add Charge_Check

Author: hkr352

examples/Charge_Check/Charge_Check.ino

@@ -0,0 +1,132 @@
+/*
+    PLEN5Stack Charge_Check.ino
+    Copyright (c) 2019,
+    - hkr352 @miya - https://github.com/hkr352
+    - PLEN Project Company Inc. - https://plen.jp
+    This software is released under the MIT License.
+    (See also : http://opensource.org/licenses/mit-license.php)
+*/
+#include <M5Stack.h>
+#include <PLEN5Stack.h>
+#include <Adafruit_NeoPixel.h> //ver 1.3.4
+
+#define IP5306_ADDR           117
+#define IP5306_REG_SYS_CTL0   0x00
+#define IP5306_REG_READ0      0x70
+#define IP5306_REG_READ1      0x71
+#define CHARGE_FULL_BIT       3
+
+#define SCL 22
+#define SDA 21
+#define POWERSWITCH 5
+#define LEDEYE 26
+#define LED_COUNT 2
+PLEN5Stack plen5stack;
+Adafruit_NeoPixel strip(LED_COUNT, LEDEYE, NEO_GRB + NEO_KHZ800);
+unsigned long time1;
+
+void setup()
+{
+  M5.begin();
+
+  pinMode(POWERSWITCH, OUTPUT);
+  digitalWrite(POWERSWITCH, LOW);
+  Wire.begin(SDA, SCL);
+  plen5stack.begin();  //PLEN Servo init
+
+  strip.begin();
+  strip.setBrightness(10);
+  setColor(strip.Color(  0,255,  0),500); // Red
+  //setColor(strip.Color(  0,  0,255),500); // Blue
+  setColor(strip.Color(255,255,  0),500); // Yellow
+  setColor(strip.Color(255,  0,  0),500); // Green
+
+  digitalWrite(POWERSWITCH, HIGH);    // motor power on
+  plenMenu();
+
+  battery_level();delay(3000);
+  
+}
+
+void loop()
+{
+  M5.update();
+  if(M5.BtnA.wasReleased())
+  {
+    M5.Lcd.fillScreen(BLACK);
+    M5.Lcd.setCursor(10, 10);
+    M5.Lcd.setTextSize(6);
+    M5.Lcd.println(" Hello !");
+    setColor(strip.Color(0,0,255),0);
+    plen5stack.motion(0x29);//Patapata: Shake arms
+    M5.Lcd.println("I'm PLEN");
+    M5.Lcd.println("5 Stack!");
+    plen5stack.motion(38);//Dance Twist
+    M5.Lcd.fillScreen(BLACK);
+    setColor(strip.Color(255,0,0),0); // Green
+    plenMenu();
+  }
+  else if(M5.BtnB.wasReleased())
+  {    
+    setColor(strip.Color(0,255,255),0);
+    plen5stack.motion(0x46);//Walk
+    plen5stack.motion(8);//Highfive
+    setColor(strip.Color(255,0,0),0);
+  }
+  else if(M5.BtnC.wasReleased())
+  {
+    plenBlink(strip.Color(255,0,0),100);
+  }// if button
+
+  if(millis()-time1 >= 1000){
+    time1 = millis();
+    battery_level();
+  }// 1 tick timer for debug
+
+} // loop
+
+void plenBlink(uint32_t color, int wait)
+{
+  setColor(strip.Color(0,0,0),wait);
+  setColor(color,wait);
+  setColor(strip.Color(0,0,0),wait);
+  setColor(color,wait);
+}
+
+void plenMenu()
+{
+  M5.Lcd.fillScreen(BLACK);
+  M5.Lcd.setCursor(5, 5);
+  M5.Lcd.setTextColor(WHITE);
+  M5.Lcd.setTextSize(1);
+  M5.Lcd.println("PLEN5Stack");
+  
+  M5.Lcd.setTextSize(6);
+  M5.Lcd.println("");
+  M5.Lcd.println("");
+  M5.Lcd.println("");
+  M5.Lcd.println("  A B C  ");
+}
+
+void setColor(uint32_t color, int wait)
+{
+  for(int i=0; i<strip.numPixels(); i++)
+  {
+    strip.setPixelColor(i, color);
+    strip.show();
+  }
+  delay(wait);
+}
+
+void battery_level()
+{
+  M5.Lcd.setTextSize(1);
+  M5.Lcd.setCursor(5,15);//(0, 200);
+  M5.Lcd.print("Battery Level: ");
+  M5.Lcd.print(M5.Power.getBatteryLevel());
+  M5.Lcd.print("%");
+  M5.Lcd.setCursor(5,25);//(0, 220);
+  if (M5.Power.getBatteryLevel() == -1){
+    M5.Lcd.print(" or Not USB IP5306");
+  }
+}

library.properties

@@ -1,5 +1,5 @@
 name=PLEN5Stack
-version=1.0.5
+version=1.0.6
 author=PLEN Project
 maintainer=miya <[email protected]>
 sentence=PLEN5Stack Library

src/PLEN5Stack.cpp

@@ -70,10 +70,16 @@ void PLEN5Stack::servoInitialSet()
     }
 }
 
+void PLEN5Stack::motionSpeed(uint16_t num){
+    if(0 <= num && num <= 20){
+        motionSpeed = num;
+    }
+}
+
 void PLEN5Stack::setAngle(int16_t angle[], uint16_t msec)
 {
     float steps[SERVO_NUM_USED] = {};
-    uint16_t motionSpeed = 10;//6; //"C++ speed" is so speedy.
+    //uint16_t motionSpeed = 10;//6; //"C++ speed" is so speedy.
     msec = msec / motionSpeed;//default 10; Speed Adj
     for (uint8_t val = 0; val < SERVO_NUM_USED; val++)
     {

src/PLEN5Stack.h

@@ -50,6 +50,7 @@ class PLEN5Stack
         float servoAngle[SERVO_NUM_USED] = {1000, 630, 300, 600, 240, 600, 1000, 720};
         //int SERVO_SET_INIT[8] = {1000, 900, 300, 900, 800, 900, 1500, 900};
         bool initController  = false;
+        uint16_t motionSpeed = 10;
         //byte error;
         void write8(uint8_t addr, uint8_t cmd);
         void weep(uint16_t eepAdr, uint8_t num);