c++/lpt-signal-generator/lpt.cpp
author František Kučera <franta-hg@frantovo.cz>
Sun, 11 Jun 2017 13:07:53 +0200
changeset 51 514b9b433dc2
parent 50 75edae164ebc
child 52 6b5c6a26693f
permissions -rw-r--r--
lpt-signal-generator: comments
franta-hg@44
     1
/**
franta-hg@44
     2
 * LPT signal generator
franta-hg@44
     3
 * Copyright © 2017 František Kučera (frantovo.cz)
franta-hg@44
     4
 *
franta-hg@44
     5
 * This program is free software: you can redistribute it and/or modify
franta-hg@44
     6
 * it under the terms of the GNU General Public License as published by
franta-hg@44
     7
 * the Free Software Foundation, either version 3 of the License, or
franta-hg@44
     8
 * (at your option) any later version.
franta-hg@44
     9
 *
franta-hg@44
    10
 * This program is distributed in the hope that it will be useful,
franta-hg@44
    11
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
franta-hg@44
    12
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
franta-hg@44
    13
 * GNU General Public License for more details.
franta-hg@44
    14
 *
franta-hg@44
    15
 * You should have received a copy of the GNU General Public License
franta-hg@44
    16
 * along with this program. If not, see <http://www.gnu.org/licenses/>.
franta-hg@44
    17
 */
franta-hg@44
    18
franta-hg@44
    19
#include <stdlib.h>
franta-hg@44
    20
#include <iostream>
franta-hg@44
    21
#include <stdio.h>
franta-hg@44
    22
#include <math.h>
franta-hg@44
    23
#include <sys/io.h>
franta-hg@44
    24
#include <unistd.h>
franta-hg@46
    25
#include <chrono> // requires -std=c++11
franta-hg@44
    26
franta-hg@45
    27
/**
franta-hg@45
    28
 * can not mix printf and wprintf
franta-hg@45
    29
 * see https://stackoverflow.com/questions/8681623/printf-and-wprintf-in-single-c-code
franta-hg@45
    30
 * > This is to be expected; your code is invoking undefined behavior.
franta-hg@45
    31
 * > Per the C standard, each FILE stream has associated with it an "orientation" (either "byte" or "wide)
franta-hg@45
    32
 * > which is set by the first operation performed on it, and which can be inspected with the fwide function.
franta-hg@45
    33
 * > Calling any function whose orientation conflicts with the orientation of the stream results in undefined behavior.
franta-hg@45
    34
 */
franta-hg@45
    35
#include <wchar.h>
franta-hg@45
    36
#include <locale.h>
franta-hg@45
    37
franta-hg@45
    38
franta-hg@44
    39
using namespace std;
franta-hg@44
    40
franta-hg@47
    41
// run this program: make run
franta-hg@46
    42
// depending on frequency and machine performance the total time will be more than given duration
franta-hg@45
    43
// despite the real-time priority, because some additional time is spent in outb() functions
franta-hg@45
    44
// so "duration" means total sleep time
franta-hg@44
    45
franta-hg@50
    46
// TODO: data types revision
franta-hg@51
    47
// TODO: time units s, μs, ns – naming convention / unification
franta-hg@50
    48
franta-hg@51
    49
/**
franta-hg@51
    50
 * generates square wave signal on a parallel port pin with given frequency and duty cycle
franta-hg@51
    51
 * mode info: https://blog.frantovo.cz/c/358/Paraleln%C3%AD%20port%20jako%20gener%C3%A1tor%20sign%C3%A1lu
franta-hg@51
    52
 */
franta-hg@44
    53
int main() {
franta-hg@45
    54
  //cout << "LPT!" << endl; // same as using printf → breaks all folllowing wprintf() calls, see note above
franta-hg@44
    55
franta-hg@45
    56
  /*
franta-hg@45
    57
   * if setlocale() is missing, unicode characters are replaced with ? or „→“ with „->“ because C/POSIX locale is used, 
franta-hg@45
    58
   * see man setlocale:
franta-hg@45
    59
   * > On startup of the main program, the portable "C" locale is selected as default.
franta-hg@45
    60
   * > If locale is an empty string, "", each part of the locale that should be modified is set according to the environment variables.
franta-hg@45
    61
   */
franta-hg@45
    62
  setlocale(LC_ALL,"");
franta-hg@44
    63
franta-hg@49
    64
franta-hg@49
    65
  // configuration ----
franta-hg@45
    66
  int addr = 0xe400; // parallel port address; first number of given port in: cat /proc/ioports | grep parport
franta-hg@45
    67
  int baseFreq = 10000; // base frequency in Hz, should be between 5 000 between 10 000 Hz; lower frequency leads to dashed/dotted lines instead of greyscale
franta-hg@48
    68
  int outputPower = 20; // duty cycle; 100 = 100 %
franta-hg@46
    69
  int duration = 1; // in seconds; total sleep time, see note above
franta-hg@49
    70
  // ------------------
franta-hg@49
    71
franta-hg@44
    72
franta-hg@45
    73
  int valueWidth =  10; // just for padding of printed values
franta-hg@45
    74
  int labelWidth = -15; // just for padding of printed labels
franta-hg@44
    75
franta-hg@45
    76
  // ' = thousand separator
franta-hg@45
    77
  // * = padding
franta-hg@46
    78
  wprintf(L"%*ls %*x\n", labelWidth, L"Parallel port:", valueWidth, addr); // or %#*x – adds 0x prefix
franta-hg@45
    79
  wprintf(L"%*ls %'*d Hz\n", labelWidth, L"Base frequency:", valueWidth, baseFreq);
franta-hg@46
    80
  wprintf(L"%*ls %*d %% duty cycle\n",  labelWidth, L"Output power:", valueWidth, outputPower);
franta-hg@46
    81
  wprintf(L"%*ls %'*d s\n", labelWidth, L"Duration:", valueWidth, duration);
franta-hg@44
    82
franta-hg@45
    83
  // in microseconds:
franta-hg@50
    84
  auto oneSecond = 1000 * 1000;
franta-hg@50
    85
  auto timeOn =  oneSecond *        outputPower  / 100 / baseFreq;
franta-hg@50
    86
  auto timeOff = oneSecond * (100 - outputPower) / 100 / baseFreq;
franta-hg@44
    87
franta-hg@50
    88
  auto cycleCount = duration * baseFreq;
franta-hg@45
    89
  wprintf(L"%*ls %'*d ×\n", labelWidth, L"Cycle count:", valueWidth, cycleCount);
franta-hg@46
    90
  wprintf(L"%*ls %'*d μs 1× in each cycle\n", labelWidth, L"Time on:",  valueWidth, timeOn);
franta-hg@46
    91
  wprintf(L"%*ls %'*d μs 1× in each cycle\n", labelWidth, L"Time off:", valueWidth, timeOff);
franta-hg@44
    92
franta-hg@46
    93
  //wprintf(L"%*ls %*ls\n", labelWidth, L"unicode test:", valueWidth, L"čeština → …");
franta-hg@44
    94
franta-hg@49
    95
  wprintf(L"\n");
franta-hg@45
    96
franta-hg@50
    97
  // TODO: test whether this address is an parallel port
franta-hg@45
    98
  if (ioperm(addr,1,1)) { fwprintf(stderr, L"Access denied to port %#x\n", addr), exit(1); }
franta-hg@45
    99
franta-hg@45
   100
franta-hg@49
   101
  // calibration
franta-hg@46
   102
  auto startTimestamp = chrono::high_resolution_clock::now();
franta-hg@49
   103
  auto calibrationCycles = 10000;
franta-hg@49
   104
  auto calibrationSleepTime = 10;
franta-hg@49
   105
franta-hg@51
   106
  for (auto i = calibrationCycles; i > 0; i--) {
franta-hg@49
   107
    outb(0b00000000, addr);
franta-hg@49
   108
    usleep(calibrationSleepTime);
franta-hg@49
   109
    outb(0b00000000, addr);
franta-hg@49
   110
    usleep(calibrationSleepTime);
franta-hg@49
   111
  }
franta-hg@49
   112
franta-hg@49
   113
  auto finishTimestamp = chrono::high_resolution_clock::now();
franta-hg@49
   114
  auto measuredDuration = chrono::duration_cast<chrono::nanoseconds>(finishTimestamp - startTimestamp).count();
franta-hg@49
   115
franta-hg@49
   116
  auto singleOutbCostNano = (measuredDuration - calibrationCycles*2*calibrationSleepTime*1000)/calibrationCycles/2;
franta-hg@49
   117
  auto singleOutbCostMicro = singleOutbCostNano/1000;
franta-hg@49
   118
franta-hg@49
   119
  wprintf(L"%*ls %'*d μs 2× in each calibration cycle\n", labelWidth, L"Single outb():", valueWidth, singleOutbCostMicro);
franta-hg@49
   120
  wprintf(L"%*ls %'*d ns 2× in each calibration cycle\n", labelWidth, L"Single outb():", valueWidth, singleOutbCostNano);
franta-hg@49
   121
franta-hg@49
   122
  auto minPower = 100*singleOutbCostNano/(1000*1000*1000/baseFreq);
franta-hg@49
   123
  auto maxPower = 100-minPower;
franta-hg@49
   124
  wprintf(L"%*ls %*d %% feasible duty cycle\n",  labelWidth, L"Minimum power:", valueWidth, minPower);
franta-hg@49
   125
  wprintf(L"%*ls %*d %% feasible duty cycle\n",  labelWidth, L"Maximum power:", valueWidth, maxPower);
franta-hg@49
   126
franta-hg@49
   127
  if (singleOutbCostMicro < timeOn && singleOutbCostMicro < timeOff) {
franta-hg@49
   128
    wprintf(L"%*ls %*ls both frequency and duty cycle should be correct\n",  labelWidth, L"Calibration:", valueWidth, L"OK");
franta-hg@49
   129
    timeOn  -= singleOutbCostMicro;
franta-hg@49
   130
    timeOff -= singleOutbCostMicro;
franta-hg@49
   131
  } else if (2*singleOutbCostMicro < (timeOn + timeOff)) {
franta-hg@49
   132
    wprintf(L"%*ls %*ls frequency should be OK, but duty cycle is not feasible\n",  labelWidth, L"Calibration:", valueWidth, L"WARNING");
franta-hg@49
   133
    timeOn  -= singleOutbCostMicro;
franta-hg@49
   134
    timeOff -= singleOutbCostMicro;
franta-hg@49
   135
franta-hg@49
   136
    if (timeOn < 0) {
franta-hg@49
   137
      timeOff -= timeOn;
franta-hg@49
   138
      timeOn = 0;
franta-hg@49
   139
    } else {
franta-hg@49
   140
      timeOn -= timeOff;
franta-hg@49
   141
      timeOff = 0;
franta-hg@49
   142
    }
franta-hg@49
   143
  } else {
franta-hg@49
   144
    wprintf(L"%*ls %*ls both frequency and duty cycle are not feasible\n",  labelWidth, L"Calibration:", valueWidth, L"ERROR");
franta-hg@49
   145
    timeOn  = 0;
franta-hg@49
   146
    timeOff = 0;
franta-hg@49
   147
  }
franta-hg@49
   148
franta-hg@49
   149
  wprintf(L"%*ls %'*d μs 1× in each cycle\n", labelWidth, L"Sleep on:",  valueWidth, timeOn);
franta-hg@49
   150
  wprintf(L"%*ls %'*d μs 1× in each cycle\n", labelWidth, L"Sleep off:", valueWidth, timeOff);
franta-hg@49
   151
franta-hg@49
   152
  wprintf(L"\n");
franta-hg@49
   153
franta-hg@49
   154
franta-hg@49
   155
  // actual signal generation
franta-hg@49
   156
  startTimestamp = chrono::high_resolution_clock::now();
franta-hg@46
   157
franta-hg@50
   158
  for (auto i = cycleCount; i > 0;  i--) {
franta-hg@46
   159
    outb(0b00000001, addr); // first data out pin = data out 0 = pin 2 on DB-25 connector
franta-hg@45
   160
    usleep(timeOn);
franta-hg@44
   161
    outb(0b00000000, addr);
franta-hg@45
   162
    usleep(timeOff);
franta-hg@44
   163
  }
franta-hg@44
   164
franta-hg@49
   165
  finishTimestamp = chrono::high_resolution_clock::now();
franta-hg@49
   166
  measuredDuration = chrono::duration_cast<chrono::nanoseconds>(finishTimestamp - startTimestamp).count();
franta-hg@46
   167
franta-hg@49
   168
  wprintf(L"%*ls %'*d μs in total\n", labelWidth, L"Deviation:", valueWidth, (measuredDuration-duration*oneSecond*1000)/1000);
franta-hg@49
   169
  wprintf(L"%*ls %'*d ns in each cycle\n", labelWidth, L"Deviation:", valueWidth, (measuredDuration-duration*oneSecond*1000)/cycleCount);
franta-hg@44
   170
franta-hg@44
   171
}