mx1-load-rs232.c

mx1ads 的bootloader下载程序

/*******************************************************************
  MX1-Loader - DragonBall M9328/MX1 loader

  mx1-load-rs232.c  - RS232 factory ROM bootstrap protocol support

  (C) Copyright 2004 by Pavel Pisa - project originator
        http://cmp.felk.cvut.cz/~pisa
  (C) Copyright 2004 PiKRON Ltd.
        http://www.pikron.com
  
  USB support based on work of Roman Bartosinski ([e-mail])


  The MX1-Loader project can be used and distributed
  in compliance with any of next licenses
   - GPL - GNU Public License
     See file COPYING for details.
   - LGPL - Lesser GNU Public License
   - MPL - Mozilla Public License
   - and other licenses added by project originator

  Code can be modified and re-distributed under any combination
  of the above listed licenses. If contributor does not agree with
  some of the licenses, he/she can delete appropriate line.
  WARNING: if you delete all lines, you are not allowed to
  distribute code or sources in any form.
 *******************************************************************/

#define _GNU_SOURCE

#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <ctype.h>
#include <termios.h>
#include <sys/time.h>
#include <sys/types.h>
#include <errno.h>
#include <unistd.h>
#include <fcntl.h>
#include "rs232_fn.h"

#include "universal-load.h"

int get_hex(char **p, unsigned *v, int chars)
{
  unsigned u=0;
  unsigned char c;
  *v=0;
  while(**p==' ') (*p)++;
  do
  { c=**p;
    if((c>='0')&&(c<='9')) c-='0';
    else if((c>='A')&&(c<='F')) c-=('A'-10);
    else {
      if(chars>=0) return -1;
      *v=u;
      return -chars;
    }
    u<<=4; u+=c;
    (*p)++;
  } while(--chars);
  *v=u;
  return 0;
};

int put_hex(char **p, unsigned long v, int chars)
{
  unsigned char c;
  while(chars--){
    c=(v>>(4*chars))&0xf;
    c+='0';
    if(c>'9') c+='A'-'9'-1;
    **p=c;
    (*p)++;
  }
  return 0;
};


int mx1_setup(uniload_alg_info_t *algi)
{
  int fd=algi->dev_fd;

  if(rs232_sendf(fd, 0, "a")<0) return -1;
  if(rs232_wait_delimit(fd,":",1000)<0){
    fprintf(stderr,"No ':' reply\n");
  }
  rs232_sendch(fd,0xd);
  if(rs232_wait_delimit(fd,"\015",1000)<0){
    fprintf(stderr,"No new line reply\n");
  }
  return 0;
}


int mx1_mem_write(uniload_alg_info_t *algi, int mem_type, unsigned long start, unsigned long len, const char *buff)
{
  int fd=algi->dev_fd;
  int res;
  char s[(4+1+32)*2];
  char *p;
  const unsigned char *b;
  int blen=31;
  int i;
  int cnt;
  char cr=0xd;
  
  while(len){
    cnt=(len>blen)?blen:len;
    p=s;
    b=buff;
    put_hex(&p, start, 8);
    put_hex(&p, 0x30*0+0x20*0+cnt, 2);
    for(i=0;i<cnt;i++)
      put_hex(&p, *(b++), 2);
    if((res=rs232_writem(fd, RS232_SF_ECHO, s, p-s))<0){
      fprintf(stderr,"write data bytes failed\n");
      return -1;
    }
    if((res=rs232_recch_wait(fd, 100))!='/'){
      fprintf(stderr,"write bad reply %c\n",res);
      return -1;
    }
    if((res=rs232_writem(fd, RS232_SF_ECHO, &cr, 1))<0){
      fprintf(stderr,"write line end failed\n");
      return -1;
    }
    
    start+=cnt;
    len-=cnt;
    buff+=cnt;
  }      
  return 0;
}


int mx1_mem_read(uniload_alg_info_t *algi, int mem_type, unsigned long start, unsigned long len, char *buff)
{
  int fd=algi->dev_fd;
  int res;
  char s[(4+1+32)*2];
  char *p;
  unsigned char *b;
  int blen=31;
  int i;
  int cnt;
  unsigned val;
  char cr=0xd;
  
  while(len){
    cnt=(len>blen)?blen:len;
    p=s;
    b=buff;
    put_hex(&p, start, 8);
    put_hex(&p, 0x30*0+0x20*1+cnt, 2);
    if((res=rs232_writem(fd, RS232_SF_ECHO, s, p-s))<0){
      fprintf(stderr,"read command failed\n");
      return -1;
    }
    if((res=rs232_readm(fd, 1000, s, cnt*2))!=cnt*2){
      fprintf(stderr,"read data failed\n");
      return -1;
    }

    p=s;
    for(i=0;i<cnt;i++){
      if((res=get_hex(&p,&val,2))<0){
	fprintf(stderr,"read hex bad format\n");
	return -1;
      }
      *(b++)=val;
    }
    if((res=rs232_recch_wait(fd, 100))!='/'){
      fprintf(stderr,"read bad reply %c\n",res);
      return -1;
    }
    if((res=rs232_writem(fd, RS232_SF_ECHO, &cr, 1))<0){
      fprintf(stderr,"write line end failed\n");
      return -1;
    }

    start+=cnt;
    len-=cnt;
    buff+=cnt;
  }      
  return 0;
}

int mx1_go_addr(uniload_alg_info_t *algi, unsigned long addr)
{
  int fd=algi->dev_fd;
  char s[16];
  char *p;
  int res;

  p=s;
  dbprintf("Starting target from %08lX\n", addr);
  put_hex(&p, addr, 8);
  put_hex(&p, 0x30*0+0x20*0+0, 2);
  if((res=rs232_writem(fd, RS232_SF_ECHO, s, p-s))<0){
    fprintf(stderr,"go command failed\n");
    return -1;
  }

  if((res=rs232_recch_wait(fd, 100))!='/'){
    fprintf(stderr,"go bad reply %c\n",res);
    return -1;
  }
  
  return 0;
}

uniload_alg_ops_t mx1_rs232_alg_ops={
  .setup=mx1_setup,
  .mem_write=mx1_mem_write,
  .mem_read=mx1_mem_read,
  .go_addr=mx1_go_addr,
};

int mx1_rs232_open(uniload_alg_info_t *algi, char *sdev, int baud, int mode, int flowc)
{
  int dev_fd;

  /* Open RS232 device */
  if ((dev_fd = open(sdev, O_RDWR | O_NONBLOCK)) == -1) {
    fprintf(stderr,"Cannot open serial device %s\n",sdev);
    return -1;
  }

  /* Set RS232 device mode and speed */
  if(rs232_setmode(dev_fd,baud,0,0)<0){
    printf("Error in rs232_setmode\n");
    close(dev_fd);
    return -1;
  }

  sleep(1);
  tcflush(dev_fd, TCIOFLUSH);
  sleep(1);

  algi->dev_fd=dev_fd;
  algi->dev_name=sdev;
  algi->alg_ops=&mx1_rs232_alg_ops;
  
  return 0;
}