ESP32_Faces.ino

/***************************************************
Copyright (c) 2020 Luis Llamas
(www.luisllamas.es)

This program is free software: you can redistribute it and/or modify it under the terms of the GNU Affero General Public License as published by
the Free Software Foundation, either version 3 of the License, or (at your option) any later version.

This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU Affero General Public License for more details.

You should have received a copy of the GNU Affero General Public License along with this program.  If not, see <http://www.gnu.org/licenses
****************************************************/

#include <M5StickC.h>

#include "Face.h"

#define WIDTH  80
#define HEIGHT 168
#define EYE 40

TFT_eSprite Buffer = TFT_eSprite(&M5.Lcd);

Face face(Buffer, HEIGHT, WIDTH, EYE);

void setup(void) {
	Serial.begin(115200);
	M5.begin();
	M5.update();

	M5.Lcd.init();

	M5.Lcd.begin();

	Buffer.setColorDepth(8);
	Buffer.createSprite(WIDTH, HEIGHT);

	face.Expression.GoTo_Normal();

	face.Behavior.Clear();
	face.Behavior.SetEmotion(eEmotions::Normal, 1.0);

	M5.MPU6886.Init();
}

void loop() {
	float accX = 0;
	float accY = 0;
	float accZ = 0;
	M5.MPU6886.getAccelData(&accX, &accY, &accZ);

	if (accZ > 0.8 || accZ < -0.8)
	{
		face.Behavior.Clear();
		face.Behavior.SetEmotion(eEmotions::Sad, 1.0);
	}
	else if (accY > 0.8)
	{
		face.Behavior.Clear();
		face.Behavior.SetEmotion(eEmotions::Angry, 1.0);
	}
	else if (accY < -0.8)
	{
		face.Behavior.Clear();
		face.Behavior.SetEmotion(eEmotions::Furious, 1.0);

	}
	else
	{
		face.Behavior.Clear();
		face.Behavior.SetEmotion(eEmotions::Normal, 2.0);
		face.Behavior.SetEmotion(eEmotions::Happy, 1.0);
	}

	face.Update();
	return;
}