Multiprotocol/Losi_cyrf6936.ino

   1 /*
   2  This project is free software: you can redistribute it and/or modify
   3  it under the terms of the GNU General Public License as published by
   4  the Free Software Foundation, either version 3 of the License, or
   5  (at your option) any later version.
   6
   7  Multiprotocol is distributed in the hope that it will be useful,
   8  but WITHOUT ANY WARRANTY; without even the implied warranty of
   9  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  10  GNU General Public License for more details.
  11
  12  You should have received a copy of the GNU General Public License
  13  along with Multiprotocol.  If not, see <http://www.gnu.org/licenses/>.
  14  */
  15
  16 #if defined(LOSI_CYRF6936_INO)
  17
  18 #include "iface_cyrf6936.h"
  19
  20 //#define LOSI_FORCE_ID
  21
  22 const uint8_t LOSI_data_code[][8] = {
  23         //(Freq-1)%5=0
  24         { 0x83, 0xF7, 0xA8, 0x2D, 0x7A, 0x44, 0x64, 0xD3 },
  25         { 0x3F, 0x2C, 0x4E, 0xAA, 0x71, 0x48, 0x7A, 0xC9 },
  26         { 0x17, 0xFF, 0x9E, 0x21, 0x36, 0x90, 0xC7, 0x82 },
  27         { 0xBC, 0x5D, 0x9A, 0x5B, 0xEE, 0x7F, 0x42, 0xEB },
  28         { 0x24, 0xF5, 0xDD, 0xF8, 0x7A, 0x77, 0x74, 0xE7 },
  29         { 0x3D, 0x70, 0x7C, 0x94, 0xDC, 0x84, 0xAD, 0x95 },
  30         { 0x1E, 0x6A, 0xF0, 0x37, 0x52, 0x7B, 0x11, 0xD4 },
  31         { 0x62, 0xF5, 0x2B, 0xAA, 0xFC, 0x33, 0xBF, 0xAF },
  32         //(Freq-1)%5=1
  33         { 0x40, 0x56, 0x32, 0xD9, 0x0F, 0xD9, 0x5D, 0x97 },
  34         { 0x8E, 0x4A, 0xD0, 0xA9, 0xA7, 0xFF, 0x20, 0xCA },
  35         { 0x4C, 0x97, 0x9D, 0xBF, 0xB8, 0x3D, 0xB5, 0xBE },
  36         { 0x0C, 0x5D, 0x24, 0x30, 0x9F, 0xCA, 0x6D, 0xBD },
  37         { 0x50, 0x14, 0x33, 0xDE, 0xF1, 0x78, 0x95, 0xAD },
  38         { 0x0C, 0x3C, 0xFA, 0xF9, 0xF0, 0xF2, 0x10, 0xC9 },
  39         { 0xF4, 0xDA, 0x06, 0xDB, 0xBF, 0x4E, 0x6F, 0xB3 },
  40         { 0x9E, 0x08, 0xD1, 0xAE, 0x59, 0x5E, 0xE8, 0xF0 },
  41         //(Freq-1)%5=2
  42         { 0xC0, 0x90, 0x8F, 0xBB, 0x7C, 0x8E, 0x2B, 0x8E },
  43         { 0x80, 0x69, 0x26, 0x80, 0x08, 0xF8, 0x49, 0xE7 },
  44         { 0x7D, 0x2D, 0x49, 0x54, 0xD0, 0x80, 0x40, 0xC1 },
  45         { 0xB6, 0xF2, 0xE6, 0x1B, 0x80, 0x5A, 0x36, 0xB4 },
  46         { 0x42, 0xAE, 0x9C, 0x1C, 0xDA, 0x67, 0x05, 0xF6 },
  47         { 0x9B, 0x75, 0xF7, 0xE0, 0x14, 0x8D, 0xB5, 0x80 },
  48         { 0xBF, 0x54, 0x98, 0xB9, 0xB7, 0x30, 0x5A, 0x88 },
  49         { 0x35, 0xD1, 0xFC, 0x97, 0x23, 0xD4, 0xC9, 0x88 },
  50         //(Freq-1)%5=3
  51         { 0xE1, 0xD6, 0x31, 0x26, 0x5F, 0xBD, 0x40, 0x93 },
  52         { 0xDC, 0x68, 0x08, 0x99, 0x97, 0xAE, 0xAF, 0x8C },
  53         { 0xC3, 0x0E, 0x01, 0x16, 0x0E, 0x32, 0x06, 0xBA },
  54         { 0xE0, 0x83, 0x01, 0xFA, 0xAB, 0x3E, 0x8F, 0xAC },
  55         { 0x5C, 0xD5, 0x9C, 0xB8, 0x46, 0x9C, 0x7D, 0x84 },
  56         { 0xF1, 0xC6, 0xFE, 0x5C, 0x9D, 0xA5, 0x4F, 0xB7 },
  57         { 0x58, 0xB5, 0xB3, 0xDD, 0x0E, 0x28, 0xF1, 0xB0 },
  58         { 0x5F, 0x30, 0x3B, 0x56, 0x96, 0x45, 0xF4, 0xA1 },
  59         //(Freq-1)%5=4
  60         { 0x03, 0xBC, 0x6E, 0x8A, 0xEF, 0xBD, 0xFE, 0xF8 },
  61         { 0x88, 0x17, 0x13, 0x3B, 0x2D, 0xBF, 0x06, 0xD6 },
  62         { 0xF1, 0x94, 0x30, 0x21, 0xA1, 0x1C, 0x88, 0xA9 },
  63         { 0xD0, 0xD2, 0x8E, 0xBC, 0x82, 0x2F, 0xE3, 0xB4 },
  64         { 0x8C, 0xFA, 0x47, 0x9B, 0x83, 0xA5, 0x66, 0xD0 },
  65         { 0x07, 0xBD, 0x9F, 0x26, 0xC8, 0x31, 0x0F, 0xB8 },
  66         { 0xEF, 0x03, 0x95, 0x89, 0xB4, 0x71, 0x61, 0x9D },
  67         { 0x40, 0xBA, 0x97, 0xD5, 0x86, 0x4F, 0xCC, 0xD1 },
  68         //Bind
  69         { 0xD7, 0xA1, 0x54, 0xB1, 0x5E, 0x89, 0xAE, 0x86 }
  70 };
  71
  72 static uint16_t __attribute__((unused)) LOSI_check(uint16_t val)
  73 {
  74         const uint8_t PROGMEM tab[] = { 0xF1, 0xDA, 0xB6, 0xC8 };
  75         uint8_t res = crc8, tmp;
  76         uint16_t calc = val>>2;                                                                 // don't care about the 2 first bits
  77         for(uint8_t i=0; i<5; i++)
  78         {
  79                 tmp=pgm_read_byte_near(&tab[i&0x03]);
  80                 if(calc&0x0001)
  81                         res ^= tmp>>4;
  82                 calc >>= 1;
  83                 if(calc&0x0001)
  84                         res ^= tmp;
  85                 calc >>= 1;
  86         }
  87         return val ^ (res<<12);
  88 }
  89
  90 static void __attribute__((unused)) LOSI_send_packet()
  91 {
  92         memcpy(packet, rx_tx_addr, 4);
  93         if(IS_BIND_IN_PROGRESS)
  94         {
  95                 memcpy(&packet[4], rx_tx_addr, 4);
  96                 crc = 0x0170;
  97                 for(uint8_t i=0; i < 8; i++)
  98                         crc += packet[i];
  99                 packet[8] = crc >> 8;
 100                 packet[9] = crc;
 101         }
 102         else
 103         {
 104                 for(uint8_t i=0; i<3; i++)
 105                 {
 106                         uint16_t val = LOSI_check(Channel_data[i]<<1);
 107                         packet[4+i*2] = val >> 8;
 108                         packet[5+i*2] = val;
 109                 }
 110         }
 111
 112         CYRF_SetPower(0x38);
 113         CYRF_WriteDataPacketLen(packet, 0x0A);
 114         #if 0
 115                 for(uint8_t i=0; i < 0x0A; i++)
 116                         debug("%02X ", packet[i]);
 117                 debugln();
 118         #endif
 119 }
 120
 121 static void __attribute__((unused)) LOSI_cyrf_init()
 122 {
 123         /* Initialise CYRF chip */
 124         CYRF_WriteRegister(CYRF_28_CLK_EN, 0x02);
 125         CYRF_WriteRegister(CYRF_32_AUTO_CAL_TIME, 0x3C);
 126         CYRF_WriteRegister(CYRF_35_AUTOCAL_OFFSET, 0x14);
 127         CYRF_WriteRegister(CYRF_06_RX_CFG, 0x48);
 128         CYRF_WriteRegister(CYRF_1B_TX_OFFSET_LSB, 0x55);
 129         CYRF_WriteRegister(CYRF_1C_TX_OFFSET_MSB, 0x05);
 130         //CYRF_WriteRegister(CYRF_0F_XACT_CFG, 0x24);
 131         CYRF_SetPower(0x38);                                                                    // 64 SDR mode -> 8 bytes data code
 132         CYRF_WriteRegister(CYRF_12_DATA64_THOLD, 0x0A);
 133         CYRF_WriteRegister(CYRF_39_ANALOG_CTRL, 0x01);
 134         CYRF_WritePreamble(0x333304);
 135         //CYRF_WriteRegister(CYRF_27_CLK_OVERRIDE, 0x00);
 136         CYRF_WriteRegister(CYRF_10_FRAMING_CFG, 0x4A);
 137         CYRF_WriteRegister(CYRF_1F_TX_OVERRIDE, 0x04);                  // No CRC
 138         //CYRF_WriteRegister(CYRF_1E_RX_OVERRIDE, 0x14);
 139         //CYRF_WriteRegister(CYRF_14_EOP_CTRL, 0x02);
 140         CYRF_ConfigDataCode(LOSI_data_code[40], 16);                    // Load bind data code by default
 141 }
 142
 143 uint16_t LOSI_callback()
 144 {
 145         #ifdef MULTI_SYNC
 146                 telemetry_set_input_sync(packet_period);
 147         #endif
 148         if(bind_counter)
 149         {
 150                 bind_counter--;
 151                 if(bind_counter==0)
 152                 {
 153                         BIND_DONE;
 154                         // Load normal data code
 155                         CYRF_ConfigDataCode(LOSI_data_code[(((hopping_frequency[0] - 1) % 5) << 3) + ((rx_tx_addr[0] + rx_tx_addr[1] + rx_tx_addr[2]) % 8)], 16);
 156                         packet_period = 19738;
 157                 }
 158         }
 159         LOSI_send_packet();
 160         return packet_period;
 161 }
 162
 163 void LOSI_init()
 164 {
 165         LOSI_cyrf_init();
 166
 167         CYRF_FindBestChannels(hopping_frequency, 1, 0, 0x07, 0x4F);     // 0x07 and 0x4F are unknown limits, this routine resets the CRC Seed to 0
 168         hopping_frequency[0] |= 1;                                                                      // Only odd channels are used, integrated in CYRF code...
 169
 170         rx_tx_addr[0] = 0x56;
 171         rx_tx_addr[1] = 0x52;
 172         rx_tx_addr[2] = 0x23;
 173         rx_tx_addr[3] = 0x8A;
 174
 175         crc8 = 0;
 176         crc8 = (uint16_t)LOSI_check(((rx_tx_addr[2]&0x0F) << 8) + rx_tx_addr[3]) >> 12;
 177
 178         #ifdef LOSI_FORCE_ID
 179                 /*
 180                 rx_tx_addr[0] = 0x47;
 181                 rx_tx_addr[1] = 0x52;
 182                 rx_tx_addr[2] = 0xAE;
 183                 rx_tx_addr[3] = 0xAA;
 184                 crc8 = 0x0B;
 185                 num_ch = 0x07;
 186                 //Data codes hopping_frequency[0] % 5
 187                 //{ 0x40, 0xBA, 0x97, 0xD5, 0x86, 0x4F, 0xCC, 0xD1, 0xD7, 0xA1, 0x54, 0xB1, 0x5E, 0x89, 0xAE, 0x86 },
 188                 //{ 0x62, 0xF5, 0x2B, 0xAA, 0xFC, 0x33, 0xBF, 0xAF, 0x40, 0x56, 0x32, 0xD9, 0x0F, 0xD9, 0x5D, 0x97 },
 189                 //{ 0x9E, 0x08, 0xD1, 0xAE, 0x59, 0x5E, 0xE8, 0xF0, 0xC0, 0x90, 0x8F, 0xBB, 0x7C, 0x8E, 0x2B, 0x8E },
 190                 //{ 0x35, 0xD1, 0xFC, 0x97, 0x23, 0xD4, 0xC9, 0x88, 0xE1, 0xD6, 0x31, 0x26, 0x5F, 0xBD, 0x40, 0x93 },
 191                 //{ 0x5F, 0x30, 0x3B, 0x56, 0x96, 0x45, 0xF4, 0xA1, 0x03, 0xBC, 0x6E, 0x8A, 0xEF, 0xBD, 0xFE, 0xF8 }
 192                 */
 193                 rx_tx_addr[0] = 0x56;
 194                 rx_tx_addr[1] = 0x52;
 195                 rx_tx_addr[2] = 0x22;
 196                 rx_tx_addr[3] = 0x8A;
 197                 crc8 = 0x0F;
 198                 num_ch = 0x02;
 199                 //Data codes hopping_frequency[0] % 5
 200                 //{ 0xF1, 0x94, 0x30, 0x21, 0xA1, 0x1C, 0x88, 0xA9, 0xD0, 0xD2, 0x8E, 0xBC, 0x82, 0x2F, 0xE3, 0xB4 },
 201                 //{ 0x17, 0xFF, 0x9E, 0x21, 0x36, 0x90, 0xC7, 0x82, 0xBC, 0x5D, 0x9A, 0x5B, 0xEE, 0x7F, 0x42, 0xEB },
 202                 //{ 0x4C, 0x97, 0x9D, 0xBF, 0xB8, 0x3D, 0xB5, 0xBE, 0x0C, 0x5D, 0x24, 0x30, 0x9F, 0xCA, 0x6D, 0xBD },
 203                 //{ 0x7D, 0x2D, 0x49, 0x54, 0xD0, 0x80, 0x40, 0xC1, 0xB6, 0xF2, 0xE6, 0x1B, 0x80, 0x5A, 0x36, 0xB4 },
 204                 //{ 0xC3, 0x0E, 0x01, 0x16, 0x0E, 0x32, 0x06, 0xBA, 0xE0, 0x83, 0x01, 0xFA, 0xAB, 0x3E, 0x8F, 0xAC }
 205
 206                 // Note: crc8=00..0F and num_ch=00..07
 207                 // num_ch = ((rx_tx_addr[0] + rx_tx_addr[1] + rx_tx_addr[2]) % 8);
 208                 // crc8 = (uint16_t)LOSI_check(((rx_tx_addr[2]&0x0F) << 8) + rx_tx_addr[3]) >> 12;
 209         #endif
 210
 211         CYRF_ConfigRFChannel(hopping_frequency[0]);
 212
 213         bind_counter = IS_BIND_IN_PROGRESS?300:1;
 214         packet_period = 8763;
 215 }
 216
 217 #endif