ESP Electro MCP, ExtSens smoothing
This commit is contained in:
@@ -1,179 +1,200 @@
|
||||
#include <Arduino.h>
|
||||
#include <ArduinoOTA.h>
|
||||
#include <Ticker.h>
|
||||
#include <AsyncMqttClient.h>
|
||||
#include <EmonLib.h>
|
||||
#include <PubSubClient.h>
|
||||
#include <SPI.h>
|
||||
|
||||
#define LED_WF (14)
|
||||
#define LED_MQ (12)
|
||||
#define LED_WRK (13)
|
||||
#define LED_WF (2) //Blue
|
||||
#define LED_WRK (3) //Green
|
||||
#define LED_MQ (4) //Red
|
||||
|
||||
#define HOST_NAME "ElectroT"
|
||||
#define MAIN_TOPIC "/home/kort/"
|
||||
|
||||
/* Hardware:
|
||||
MCP3201 Pin ---------------- ESP8266 Pin
|
||||
- 1-VREF ---------------- 3,3V
|
||||
- 2-IN+ ---------------- ANALOG SIGNAL +
|
||||
- 3-IN- ---------------- ANALOG SIGNAL -
|
||||
- 4-GND ---------------- GND
|
||||
- 5-CS ----CS---------- GPIO15 / CS
|
||||
- 6-Dout(MISO)----MISO-------- GPIO12 / MISO
|
||||
- 7-CLK ----SCLK-------- GPIO14
|
||||
- 8-VDD ---------------- 3.3V
|
||||
*/
|
||||
|
||||
const char* ssid = "wf-home";
|
||||
const char* password = "0ndthnrf";
|
||||
const char* mqtt_server = "192.168.1.250";
|
||||
|
||||
const int scePin = 15; // SCE - Chip select
|
||||
|
||||
const double vRef = 3.3;
|
||||
const int period = 1000; //us
|
||||
|
||||
unsigned long cRun = millis();
|
||||
double curr;
|
||||
double curr = 0.0;
|
||||
double currT = 0.0;
|
||||
double currM = 0.0;
|
||||
int nSec, nSampl;
|
||||
|
||||
EnergyMonitor emon1;
|
||||
void connectToWifi();
|
||||
void connectToMqtt();
|
||||
|
||||
WiFiClient espClient;
|
||||
PubSubClient mClient(espClient);
|
||||
void reconnect();
|
||||
|
||||
AsyncMqttClient mqttClient;
|
||||
Ticker mqttReconnectTimer;
|
||||
|
||||
WiFiEventHandler wifiConnectHandler;
|
||||
WiFiEventHandler wifiDisconnectHandler;
|
||||
Ticker wifiReconnectTimer;
|
||||
|
||||
void spiBegin();
|
||||
void mcp_output();
|
||||
|
||||
Ticker tckrElcnt(mcp_output, period, 0, MILLIS);
|
||||
|
||||
void connectToWifi() {
|
||||
Serial.println("Connecting to Wi-Fi...");
|
||||
WiFi.begin(ssid, password);
|
||||
}
|
||||
|
||||
void connectToMqtt() {
|
||||
Serial.println("Connecting to MQTT...");
|
||||
mqttClient.connect();
|
||||
while (!WiFi.isConnected()){
|
||||
Serial.print(".");
|
||||
delay(1000);
|
||||
}
|
||||
}
|
||||
|
||||
void onWifiConnect(const WiFiEventStationModeGotIP& event) {
|
||||
Serial.println("Connected to Wi-Fi.");
|
||||
Serial.print("IP: ");
|
||||
Serial.println(WiFi.localIP());
|
||||
connectToMqtt();
|
||||
Serial.println("Connecting to MQTT...");
|
||||
//reconnect();
|
||||
digitalWrite(LED_WF, HIGH);
|
||||
}
|
||||
|
||||
void onWifiDisconnect(const WiFiEventStationModeDisconnected& event) {
|
||||
Serial.println("Disconnected from Wi-Fi.");
|
||||
mqttReconnectTimer.detach(); // ensure we don't reconnect to MQTT while reconnecting to Wi-Fi
|
||||
wifiReconnectTimer.once(2, connectToWifi);
|
||||
digitalWrite(LED_WF, LOW);
|
||||
}
|
||||
|
||||
void onMqttConnect(bool sessionPresent) {
|
||||
Serial.println("Connected to MQTT.");
|
||||
Serial.print("Session present: ");
|
||||
Serial.println(sessionPresent);
|
||||
digitalWrite(LED_MQ, HIGH);
|
||||
}
|
||||
|
||||
void onMqttDisconnect(AsyncMqttClientDisconnectReason reason) {
|
||||
//Serial.println("Disconnected from MQTT.");
|
||||
|
||||
if (WiFi.isConnected()) {
|
||||
mqttReconnectTimer.once(2, connectToMqtt);
|
||||
}
|
||||
digitalWrite(LED_MQ, LOW);
|
||||
}
|
||||
|
||||
|
||||
void setup(){
|
||||
Serial.begin(9600);
|
||||
WiFi.mode(WIFI_STA);
|
||||
WiFi.hostname("Electro");
|
||||
Serial.begin(9600);
|
||||
WiFi.hostname(HOST_NAME);
|
||||
Serial.begin(115200);
|
||||
|
||||
emon1.current(0, 30.0);
|
||||
|
||||
ArduinoOTA.onStart([]() {
|
||||
Serial1.println("Start Update"); // "Начало OTA-апдейта"
|
||||
});
|
||||
ArduinoOTA.onEnd([]() {
|
||||
Serial1.println("\nEnd Update"); // "Завершение OTA-апдейта"
|
||||
});
|
||||
ArduinoOTA.onProgress([](unsigned int progress, unsigned int total) {
|
||||
//Serial1.printf("Progress: %u%%\r", (progress / (total / 100)));
|
||||
});
|
||||
ArduinoOTA.onError([](ota_error_t error) {
|
||||
Serial1.printf("Error[%u]: ", error);
|
||||
if (error == OTA_AUTH_ERROR) Serial1.println("Auth Failed");
|
||||
// "Ошибка при аутентификации"
|
||||
else if (error == OTA_BEGIN_ERROR) Serial1.println("Begin Failed");
|
||||
// "Ошибка при начале OTA-апдейта"
|
||||
else if (error == OTA_CONNECT_ERROR) Serial1.println("Connect Failed");
|
||||
// "Ошибка при подключении"
|
||||
else if (error == OTA_RECEIVE_ERROR) Serial1.println("Receive Failed");
|
||||
// "Ошибка при получении данных"
|
||||
else if (error == OTA_END_ERROR) Serial1.println("End Failed");
|
||||
// "Ошибка при завершении OTA-апдейта"
|
||||
});
|
||||
ArduinoOTA.begin();
|
||||
|
||||
wifiConnectHandler = WiFi.onStationModeGotIP(onWifiConnect);
|
||||
wifiDisconnectHandler = WiFi.onStationModeDisconnected(onWifiDisconnect);
|
||||
|
||||
mqttClient.onConnect(onMqttConnect);
|
||||
mqttClient.onDisconnect(onMqttDisconnect);
|
||||
mqttClient.setServer(mqtt_server, 1883);
|
||||
mqttClient.setClientId("Electro");
|
||||
mClient.setServer("192.168.1.250", 1883);
|
||||
|
||||
pinMode(LED_WF, OUTPUT);
|
||||
pinMode(LED_MQ, OUTPUT);
|
||||
pinMode(LED_WRK, OUTPUT);
|
||||
//pinMode(5, INPUT_PULLUP);
|
||||
pinMode(scePin, OUTPUT);
|
||||
digitalWrite(scePin, HIGH);
|
||||
//spiBegin();
|
||||
digitalWrite(LED_WF, LOW);
|
||||
digitalWrite(LED_MQ, LOW);
|
||||
digitalWrite(LED_WRK, LOW);
|
||||
|
||||
connectToWifi();
|
||||
nSec = 0;
|
||||
curr = -1;
|
||||
nSampl = 0;
|
||||
//tckrElcnt.start();
|
||||
}
|
||||
|
||||
void loop(){
|
||||
static bool led_wrk = false;
|
||||
|
||||
//tckrElcnt.update();
|
||||
ArduinoOTA.handle();
|
||||
yield();
|
||||
if(!mClient.connected()){
|
||||
reconnect();
|
||||
}
|
||||
mClient.loop();
|
||||
if(cRun + 999 < millis()){
|
||||
cRun = millis();
|
||||
double Irms = 0;
|
||||
mcp_output();
|
||||
nSampl++;
|
||||
currM += curr;
|
||||
if(WiFi.isConnected()){
|
||||
Irms = emon1.calcIrms(1480) - 0.5;
|
||||
if(curr < 0){
|
||||
curr = Irms;
|
||||
}
|
||||
else{
|
||||
//curr += (Irms - curr) / 60;
|
||||
curr += (Irms);
|
||||
}
|
||||
// Serial.print("Sec: ");
|
||||
// yield();
|
||||
// Serial.print(nSec);
|
||||
// yield();
|
||||
Serial.printf("Sec: %d\t%.2f\n", nSec, curr);
|
||||
// Serial.print("\t");
|
||||
// yield();
|
||||
// Serial.print(Irms);
|
||||
// yield();
|
||||
// Serial.print("\t");
|
||||
// yield();
|
||||
// Serial.println(Irms * 233);
|
||||
// Serial.println(curr * 233);
|
||||
led_wrk = !led_wrk;
|
||||
digitalWrite(LED_WRK, led_wrk);
|
||||
nSampl++;
|
||||
}
|
||||
if(++nSec > 59){
|
||||
nSec = 0;
|
||||
// Serial.print("Millis: ");
|
||||
// yield();
|
||||
// Serial.print(millis());
|
||||
// yield();
|
||||
// Serial.print("\t");
|
||||
// yield();
|
||||
// Serial.print(curr);
|
||||
// yield();
|
||||
// Serial.print("\t");
|
||||
// yield();
|
||||
// Serial.println(curr * 233);
|
||||
if(nSampl > 0){
|
||||
//Serial.println("Publish");
|
||||
curr = curr / (double)nSampl;
|
||||
char v[7];
|
||||
sprintf(v, "%.2f", curr);
|
||||
mqttClient.publish("/home/kor/curr", 1, false, v);
|
||||
}
|
||||
nSampl = 0;
|
||||
curr = -1;
|
||||
currM = currM / 60.0;
|
||||
char v[7];
|
||||
Serial.printf("Publish min, curr=%.2f\n", currM);
|
||||
sprintf(v, "%.2f", curr);
|
||||
mClient.publish(MAIN_TOPIC "curr", v);
|
||||
//mqttClient.publish(MAIN_TOPIC "curr", 1, false, v);
|
||||
currM = 0.0;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
void mcp_output(){
|
||||
double currTI = 0.0;
|
||||
int sampl = 0;
|
||||
int out = 0;
|
||||
unsigned long start = micros();
|
||||
//while((start + 20000) >= micros()){
|
||||
SPI.begin();
|
||||
SPI.setDataMode(SPI_MODE0);
|
||||
SPI.setBitOrder(MSBFIRST);
|
||||
SPI.setFrequency(800000);
|
||||
digitalWrite(scePin, LOW);
|
||||
out = SPI.transfer16(0x0000);
|
||||
digitalWrite(scePin, HIGH);
|
||||
//yield();
|
||||
//delayMicroseconds(5);
|
||||
out = out << 3; //Must shift out the 3 MSB's (trash bits)
|
||||
out = out >> 4;
|
||||
currTI += out;// * (vRef / 4096); // Using VRef
|
||||
sampl++;
|
||||
//}
|
||||
Serial.printf("Time=%d, Out = %d, Samples=%d\n", int(micros() - start), out, sampl);
|
||||
//curr = 30.0 * sqrt(currTI / sampl);
|
||||
curr = currTI / sampl;
|
||||
}
|
||||
|
||||
|
||||
void spiBegin(void)
|
||||
{
|
||||
pinMode(scePin, OUTPUT);
|
||||
|
||||
SPI.begin();
|
||||
SPI.setDataMode(SPI_MODE0);
|
||||
SPI.setBitOrder(MSBFIRST);
|
||||
SPI.setFrequency(800000);
|
||||
digitalWrite(scePin, HIGH);
|
||||
}
|
||||
|
||||
void reconnect() {
|
||||
// Loop until we're reconnected
|
||||
if(!WiFi.isConnected()) return;
|
||||
while (!mClient.connected()) {
|
||||
Serial.print("Attempting MQTT connection...");
|
||||
// Attempt to connect
|
||||
if (mClient.connect(HOST_NAME)) {
|
||||
Serial.println("connected");
|
||||
// Once connected, publish an announcement...
|
||||
} else {
|
||||
Serial.print("failed, rc=");
|
||||
Serial.print(mClient.state());
|
||||
Serial.println(" try again in 5 seconds");
|
||||
// Wait 0.5 seconds before retrying
|
||||
delay(500);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user