ardumote/ActorAnalog3.cpp at master · mdular/ardumote · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
/*
    http://www.ardumote.com
    Copyright (c) 2012 Suat Özgür
    http://opensource.org/licenses/MIT
*/

#include "Arduino.h"
#include "ActorAnalog3.h"

void ActorAnalog3::setup(char* sName, int nAnalogPin1, int nAnalogPin2, int nAnalogPin3) {
  setName(sName);
  nPin1 = nAnalogPin1;
  nPin2 = nAnalogPin2;
  nPin3 = nAnalogPin3;
  pinMode(nPin1, OUTPUT);
  pinMode(nPin2, OUTPUT);
  pinMode(nPin3, OUTPUT);
  nDeviceTypeID = 7;
}

bool ActorAnalog3::exec(char* p) {
  int p1 = NULL;
  int p2 = NULL;
  int p3 = NULL;
  char* pch;

  pch = strtok (p, ",");
  while (pch != NULL)  {
    if (p1==NULL) {
        p1 = atoi(pch);
    } else if (p2!=NULL) {
        p2 = atoi(pch);
    } else if (p3!=NULL) {
        p3 = atoi(pch);
    }
    pch = strtok (NULL, ",");
  }

  if (p1>255) {
    analogWrite(nPin1, 255);
  } else if (p1 <= 0) {
    analogWrite(nPin1, 0);
  } else {
    analogWrite(nPin1, p1);
  }

  if (p2>255) {
    analogWrite(nPin2, 255);
  } else if (p2 <= 0) {
    analogWrite(nPin2, 0);
  } else {
    analogWrite(nPin2, p2);
  }

  if (p3>255) {
    analogWrite(nPin3, 255);
  } else if (p3 <= 0) {
    analogWrite(nPin3, 0);
  } else {
    analogWrite(nPin3, p3);
  }

  return true;
}