wctrl.c

/*
  ターゲット側の書き込みプログラム
  Satofumi KAMIMURA
  $Id$
*/

#include "wctrl.h"
#include "tiny_sci.h"


struct st_flm {
  struct { unsigned char BYTE; } FLMCR1;
};
#define LOOP(X) for(i = X; i > 0; i--) /* Wait Loop */


// 符号なし数字文字列を数値に変換する
static int atoi(char *str) {
  int ret_value = 0;
  int index;

  for (index = 0; (str[index] >= '0') && (str[index] <= '9'); ++index) {
    ret_value *= 10;
    ret_value += str[index] - '0';
  }

  return ret_value;
}


static int adjustBaudrate(void) {
  char recv_buffer[16];
  int n;

  // ボーレート設定の受け取り
  n = recvLine(recv_buffer, 16);
  if (recv_buffer[0] == 'S') {
    if (!setBaudrate(atoi(&recv_buffer[1]))) {
      putch('0');
      return 0;
    }
  }
  putch('E');
  return -1;
}


static int writeFlushRom(long addr, char *data) {
  volatile char *address = (char *)addr;
  volatile char *flmcr = (char *)FLMCR1_ADDR;
  volatile int i = 0;           /* use LOOP() */
  char rewrite[32];
  char verify;
  int n, m, j;

  if (addr > 0x0001ffff) {
    flmcr += 1;
  }

  FLM.FLMCR1.BYTE |= 0x40;      /* FLMR1 SWE=1 */
  LOOP(WAIT_10u);

  for (j = 0; j < 32; ++j) {
    rewrite[j] = data[j];
  }

  n = 1;
  do {
    for (j = 0; j < 32; ++j) {  /* data byte write */
      *(address + j) = rewrite[j];
    }

    WDT_TCSR_WORD = WDT_573u; /* set WDT */

    *flmcr = 0x50;              /* set FLMCR1(2) PSU1(2)=1 */
    LOOP(WAIT_50u);

    *flmcr = 0x51;              /* set FLMCR1(2) P1(2)=1 */
    LOOP(WAIT_200u);

    *flmcr = 0x50;              /* set FLMCR1(2) P1(2)=0 */
    LOOP(WAIT_10u);

    *flmcr = 0x40;              /* set FLMCR1(2) PSU1(2)=0 */
    LOOP(WAIT_10u);

    WDT_TCSR_WORD = WDT_STOP;   /* stop WDT */
    *flmcr = 0x44;              /* set FLMCR1(2) PV1(2)=1 */
    LOOP(WAIT_4u);

    m = 0;
    for (j = 0; j < 32; j++) {
      *(address + j) = 0xff;
      rewrite[j] = 0xff;
      LOOP(WAIT_2u);
      verify = *(address + j);
      if (data[j] != verify) {
        m = 1;
      }
      rewrite[j] = ~(data[j] ^ verify) | data[j];
    }

    *flmcr = 0x40;              /* set FLMCR1(2) PV1(2)=0 */
    LOOP(WAIT_4u);

  } while ((m != 0) && (n++ < WRITE_TIMES));

  FLM.FLMCR1.BYTE = 0x00;       /* FLMR1 SWE=0 */
  if (m != 0) {
    return -1;
  }
  return 0;
}


static void writeRom(void) {
  unsigned char data[32];
  unsigned long addr;
  unsigned char check_sum;
  unsigned char sum;
  int retry_times = 0;
  int i;
  char ch;

  while (1) {
    sum = 0x00;
    addr = 0x0000;
    for (i = 0; i < 4; ++i) {
      ch = getch();
      addr = (addr << 8) + (unsigned char)ch;
      sum += ch;
    }
    for (i = 0; i < 32; ++i) {
      ch = getch();
      data[i] = (unsigned char)ch;
      sum += ch;
    }
    check_sum = getch();

    // チェックサム
    if (sum != check_sum) {
      ++retry_times;
      putch('0' + retry_times++);
      continue;
    }

    /* F-ZTAT への書き込み */
    if (writeFlushRom(addr, data)) {
      putch('E');
      break;
    }
    retry_times = 0;
    putch('0');
  }
}


void __main(void){};
int main(void) {

  // シリアルデバイスの初期化
  initSCI();

  // データ転送ボーレート設定の受け取りと更新
  if (!adjustBaudrate()) {
    writeRom();                 // データ受信と書き込み
  }

  // 終了
  while (1)
    ;
}