radio/src/targets/sky9x/coproc_driver.cpp

   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 #include "opentx.h"
  22
  23 int8_t volumeRequired ;
  24 uint8_t coprocReadDataPending ;
  25 uint8_t coprocWriteDataPending ;
  26 uint8_t CoProc_appgo_pending ;
  27 uint8_t Volume_read ;
  28 uint8_t Coproc_read ;
  29 int8_t Coproc_temp ;
  30 int8_t Coproc_maxtemp=-127 ;
  31 int8_t Coproc_valid ;
  32 bool get_onlytemp;
  33 #if !defined(SIMU)
  34 // TODO not used? static uint8_t *Twi_read_address ;
  35 #endif
  36 static uint8_t TwiOperation ;
  37
  38 #define TWI_NONE          0
  39 #define TWI_WRITE_VOL     2
  40 #define TWI_READ_COPROC   3
  41 #define TWI_COPROC_APPGO  4
  42 #define TWI_WAIT_STOP     5
  43 #define TWI_WRITE_COPROC  6
  44
  45 // Commands to the coprocessor bootloader/application
  46 #define TWI_CMD_PAGEUPDATE          0x01  // TWI Command to program a flash page
  47 #define TWI_CMD_EXECUTEAPP          0x02  // TWI Command to jump to the application program
  48 #define TWI_CMD_SETREAD_ADDRESS     0x03  // TWI Command to set address to read from
  49 #define TWI_CMD_WRITE_DATA          0x04  // TWI Command send data to the application
  50 #define COPROC_RX_BUXSIZE   22
  51 uint8_t Co_proc_status[COPROC_RX_BUXSIZE] ;
  52 uint8_t *coprocWriteDataPtr ;
  53 uint32_t coprocWriteDataSize ;
  54
  55
  56 // This is called from an interrupt routine, or
  57 // interrupts must be disabled while it is called
  58 // from elsewhere.
  59 void i2cCheck()
  60 {
  61   if ( TWI0->TWI_IMR & TWI_IMR_TXCOMP ) {
  62     return ;    // Busy
  63   }
  64
  65   if ( volumeRequired >= 0 ) {      // Set volume to this value
  66     TWI0->TWI_MMR = 0x002F0000 ;    // Device 5E (>>1) and master is writing
  67     TwiOperation = TWI_WRITE_VOL ;
  68     TWI0->TWI_THR = volumeRequired ;   // Send data
  69     volumeRequired = -1 ;
  70     TWI0->TWI_IER = TWI_IER_TXCOMP ;
  71     TWI0->TWI_CR = TWI_CR_STOP ;    // Stop Tx
  72   }
  73   else if (coprocReadDataPending) {
  74     Coproc_valid = 0 ;
  75     coprocReadDataPending = 0 ;
  76     TWI0->TWI_MMR = 0x00351000 ;    // Device 35 and master is reading
  77     TwiOperation = TWI_READ_COPROC ;
  78 #ifndef SIMU
  79     TWI0->TWI_RPR = (uint32_t)&Co_proc_status[0] ;
  80 #endif
  81     TWI0->TWI_RCR = COPROC_RX_BUXSIZE - 1 ;
  82     if ( TWI0->TWI_SR & TWI_SR_RXRDY ) {
  83       (void) TWI0->TWI_RHR ;
  84     }
  85     TWI0->TWI_PTCR = TWI_PTCR_RXTEN ; // Start transfers
  86     TWI0->TWI_CR = TWI_CR_START ;   // Start Rx
  87     TWI0->TWI_IER = TWI_IER_RXBUFF | TWI_IER_TXCOMP ;
  88   }
  89   else if ( CoProc_appgo_pending ) {
  90     CoProc_appgo_pending = 0 ;
  91     TWI0->TWI_MMR = 0x00350000 ;    // Device 35 and master is writing
  92     TwiOperation = TWI_COPROC_APPGO ;
  93     TWI0->TWI_THR = TWI_CMD_EXECUTEAPP ;  // Send appgo command
  94     TWI0->TWI_IER = TWI_IER_TXCOMP ;
  95     TWI0->TWI_CR = TWI_CR_STOP ;    // Stop Tx
  96   }
  97   else if ( coprocWriteDataPending ) {
  98     coprocWriteDataPending = 0 ;
  99     TWI0->TWI_MMR = 0x00350000 ;    // Device 35 and master is writing
 100     TwiOperation = TWI_WRITE_COPROC ;
 101 #ifndef SIMU
 102     TWI0->TWI_TPR = (uint32_t)coprocWriteDataPtr ;
 103 #endif
 104     TWI0->TWI_TCR = coprocWriteDataSize ;
 105     TWI0->TWI_THR = TWI_CMD_WRITE_DATA ;  // Send write command
 106     TWI0->TWI_PTCR = TWI_PTCR_TXTEN ; // Start data transfer
 107     TWI0->TWI_IER = TWI_IER_TXBUFE | TWI_IER_TXCOMP ;
 108   }
 109 }
 110
 111 void coprocReadData(bool onlytemp)
 112 {
 113   get_onlytemp = onlytemp;
 114   coprocReadDataPending = 1 ;
 115   __disable_irq() ;
 116   i2cCheck() ;
 117   __enable_irq() ;
 118 }
 119
 120 void coprocWriteData(uint8_t *data, uint32_t size)
 121 {
 122   coprocWriteDataPtr = data;
 123   coprocWriteDataSize = size;
 124   coprocWriteDataPending = 1;
 125   __disable_irq();
 126   i2cCheck();
 127   __enable_irq();
 128 }
 129
 130 #if !defined(SIMU)
 131 extern "C" void TWI0_IRQHandler()
 132 {
 133   if ( TwiOperation == TWI_READ_COPROC )
 134   {
 135     if ( TWI0->TWI_SR & TWI_SR_RXBUFF )
 136     {
 137       TWI0->TWI_IDR = TWI_IDR_RXBUFF ;
 138       TwiOperation = TWI_WAIT_STOP ;
 139       TWI0->TWI_CR = TWI_CR_STOP ;  // Stop Rx
 140       TWI0->TWI_RCR = 1 ;           // Last byte
 141       return ;
 142     }
 143     else
 144     {
 145       Coproc_valid = -1 ;
 146     }
 147   }
 148
 149   if ( TwiOperation == TWI_WAIT_STOP )
 150   {
 151     Coproc_valid = 1 ;
 152     Coproc_read = Co_proc_status[0] ;
 153     if ( Coproc_read & 0x80 ) {
 154       // Bootloader
 155       CoProc_appgo_pending = 1 ;  // Action application
 156     }
 157     else {
 158       // Got data from tiny app
 159       // Set the date and time
 160       struct gtm utm;
 161       if (!get_onlytemp) {
 162         utm.tm_sec = Co_proc_status[1] ;
 163         utm.tm_min = Co_proc_status[2] ;
 164         utm.tm_hour = Co_proc_status[3] ;
 165         utm.tm_mday = Co_proc_status[4] ;
 166         utm.tm_mon = Co_proc_status[5] - 1;
 167         utm.tm_year = (Co_proc_status[6] + ( Co_proc_status[7] << 8 )) - TM_YEAR_BASE;
 168         g_rtcTime = gmktime(&utm);
 169       }
 170       Coproc_temp = Co_proc_status[8];
 171       if (Coproc_temp > Coproc_maxtemp)
 172         Coproc_maxtemp=Coproc_temp;
 173     }
 174     TWI0->TWI_PTCR = TWI_PTCR_RXTDIS ;  // Stop transfers
 175     if ( TWI0->TWI_SR & TWI_SR_RXRDY ) {
 176       (void) TWI0->TWI_RHR ;      // Discard any rubbish data
 177     }
 178   }
 179
 180 //  if ( TwiOperation == TWI_WRITE_VOL )
 181 //  {
 182
 183 //  }
 184
 185   if ( TwiOperation == TWI_WRITE_COPROC )
 186   {
 187     if ( TWI0->TWI_SR & TWI_SR_TXBUFE )
 188     {
 189       TWI0->TWI_IDR = TWI_IDR_TXBUFE ;
 190       TWI0->TWI_CR = TWI_CR_STOP ;    // Stop Tx
 191       TWI0->TWI_PTCR = TWI_PTCR_TXTDIS ;  // Stop transfers
 192       TwiOperation = TWI_NONE ;
 193       return ;
 194     }
 195   }
 196
 197   TWI0->TWI_IDR = TWI_IDR_TXCOMP | TWI_IDR_TXBUFE | TWI_IDR_RXBUFF ;
 198   TWI0->TWI_PTCR = TWI_PTCR_TXTDIS | TWI_PTCR_RXTDIS ; // Stop transfers
 199   if ( TWI0->TWI_SR & TWI_SR_NACK )
 200   {
 201   }
 202   TwiOperation = TWI_NONE ;
 203   i2cCheck() ;
 204 }
 205 #endif