radio/src/pulses/pxx.h

   1 /*
   2  * Copyright (C) OpenTX
   3  *
   4  * Based on code named
   5  *   th9x - http://code.google.com/p/th9x
   6  *   er9x - http://code.google.com/p/er9x
   7  *   gruvin9x - http://code.google.com/p/gruvin9x
   8  *
   9  * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License version 2 as
  13  * published by the Free Software Foundation.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  */
  20
  21 #ifndef _PULSES_PXX_H_
  22 #define _PULSES_PXX_H_
  23
  24 #include "pulses_common.h"
  25
  26 #define PXX_SEND_BIND                      0x01
  27 #define PXX_SEND_FAILSAFE                  (1 << 4)
  28 #define PXX_SEND_RANGECHECK                (1 << 5)
  29
  30 #define PXX2_LOWSPEED_BAUDRATE             230400
  31 #define PXX2_HIGHSPEED_BAUDRATE            450000
  32 #define PXX2_PERIOD                        4 // 4ms
  33 #define PXX2_TOOLS_PERIOD                  1 // 1ms
  34 #define PXX2_FRAME_MAXLENGTH               64
  35
  36 #define PXX_PULSES_PERIOD                  9/*ms*/
  37 #define EXTMODULE_PXX1_SERIAL_PERIOD       4/*ms*/
  38 #define EXTMODULE_PXX1_SERIAL_BAUDRATE     420000
  39
  40 #if defined(PXX_FREQUENCY_HIGH)
  41   #define INTMODULE_PXX1_SERIAL_BAUDRATE   450000
  42   #define INTMODULE_PXX1_SERIAL_PERIOD     4/*ms*/
  43 #else
  44   #define INTMODULE_PXX1_SERIAL_BAUDRATE   115200
  45   #define INTMODULE_PXX1_SERIAL_PERIOD     9/*ms*/
  46 #endif
  47
  48 // Used by the Sky9x family boards
  49 class SerialPxxBitTransport: public DataBuffer<uint8_t, 64> {
  50   protected:
  51     uint8_t byte;
  52     uint8_t bits_count;
  53
  54     void initFrame(uint32_t period)
  55     {
  56       initBuffer();
  57       byte = 0;
  58       bits_count = 0;
  59     }
  60
  61     void addSerialBit(uint8_t bit)
  62     {
  63       byte >>= 1;
  64       if (bit & 1) {
  65         byte |= 0x80;
  66       }
  67       if (++bits_count >= 8) {
  68         *ptr++ = byte;
  69         bits_count = 0;
  70       }
  71     }
  72
  73     // 8uS/bit 01 = 0, 001 = 1
  74     void addPart(uint8_t value)
  75     {
  76       addSerialBit(0);
  77       if (value) {
  78         addSerialBit(0);
  79       }
  80       addSerialBit(1);
  81     }
  82
  83     void addTail()
  84     {
  85       while (bits_count != 0) {
  86         addSerialBit(1);
  87       }
  88     }
  89 };
  90
  91 class PwmPxxBitTransport: public PulsesBuffer<pulse_duration_t, 200> {
  92   protected:
  93     uint16_t rest;
  94
  95     void initFrame(uint32_t period)
  96     {
  97       initBuffer();
  98       rest = period * 2000; // 0.5uS (2Mhz)
  99     }
 100
 101     void addPart(uint8_t value)
 102     {
 103       pulse_duration_t duration = value ? 47 : 31;
 104       *ptr++ = duration;
 105       rest -= duration + 1;
 106     }
 107
 108     void addTail()
 109     {
 110       // rest min value is 18000 - 200 * 48 = 8400 (4.2ms)
 111       *(ptr - 1) += rest;
 112     }
 113 };
 114
 115 #endif