iolinker/pwm_example.cpp at master · jvm123/iolinker · 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
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
/**
 * (C) 2016 jInvent Software Development <prog@jinvent.de>
 * MIT License
 * --
 * http://jinvent.de/IOLinker
 **/

/**
 * @file IOLinker_unittest.cpp
 * @author Julian von Mendel
 * @brief Quick test program for IOLinker class with PWM example
 **/

#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <math.h>
#include <algorithm>
#include "IOLinker.h"

int main(void)
{
    /* Initialize class */
    IOLinker iolinker;

    iolinker.beginSerial("/dev/ttyUSB0");
    iolinker.targetAddress(0x7f);
    /*uint8_t idx = iolinker.firstAddress();
    printf("The first slave address is %d, and the chain length from there is %d.\n",
            idx, iolinker.chainLength(idx));
*/
    if (iolinker.version() == 0) {
        printf("ERROR: No response from iolinker (version %x).\n",
                iolinker.version());
        //return 0;
    } else {
        printf("iolinker is responding.\n");
    }

    printf("Version %x.\n",
            iolinker.version());
    iolinker.clearPinFunctions(1, 49);

    uint8_t led1 = 1, led4 = 7, button = 2;
    iolinker.setPinType(IOLinker::IOLINKER_OUTPUT, 8);
    iolinker.setPinType(IOLinker::IOLINKER_INPUT, button);
    iolinker.setOutput(true, 8);

    if (iolinker.readInput(button)) {
        printf("Input %d is high.\n", button);
    } else {
        printf("Input %d is low.\n", button);
    }

    printf("Press the push button to start!\n");
    while (!iolinker.readInput(button)) {}

    iolinker.setPinType(IOLinker::IOLINKER_OUTPUT, led1, led4);

    printf("Set pins %d to %d high.\n", led1, led4);
    iolinker.setOutput(true, led1, led4);
    usleep(100000);

    setbuf(stdout, NULL);
    for (uint8_t j = 0; j < 4 || 1; j++) {
        printf("PWM");
        for (uint8_t i = 0; i < 128; i++) {
            printf(" %d", i);
            iolinker.pwm(i, led4 - 1);
            iolinker.pwm(127 - i, led1, led4 - 2);
            iolinker.pwm(i, led4);
            usleep(5000);
        }
        printf("\n");
        printf("PWM");
        for (uint8_t i = 127; i > 0; i--) {
            printf(" %d", i);
            iolinker.pwm(i, led4 - 1);
            iolinker.pwm(127 - i, led1, led4 - 2);
            iolinker.pwm(i, led4);
            usleep(5000);
        }
        printf("\n");
    }

    iolinker.pwm(100, led1, led4);
    printf("Link %d to %d with pin 11.\n", led1, led4);
    iolinker.link(11, led1, led4);
    printf("Sleeping 10s...\n");
    sleep(10);
    printf("Link %d to %d with pin 11.\n", led1, led4);
    iolinker.clearPinFunctions(led1, led4);
    iolinker.link(11, led1, led4);
    return 1;
}