Subversion Repositories Projects

/*******************************************

 *                                          

 * Handling of MK LCD                      

 *                                          

 * Author:        Marcus -LiGi- Bueschleb  

 * see README for further Infos

 *

 *

 *******************************************/

package org.ligi.ufo;

import java.io.*;

//#ifdef j2me

//# import javax.microedition.io.*;

//#endif

public class MKFirmwareFlasher

    implements Runnable

{

    public String[] flash_msgs;

    public int msg_pos=0;

    public int bootloader_init_attempt;

    private InputStream reader;    

    private OutputStream writer;    

    private StreamConnection connection;

    private byte[] bl_magic={(byte)'M',(byte)'K',(byte)'B',(byte)'L'};

    private byte bl_magic_pos=0;

    private boolean got_bl_magic=false;

    private int attempt=0;

    byte intension=0;

    public boolean success=false;

    public boolean job_done=false;

    public boolean started=false;

    public MKFirmwareFlasher(String _url,byte _intension)

    {

        intension=_intension;

        url=_url;

        flash_msgs=new String[100];

        log("loading BL Handler");

    }

    public void start()

    {

        started=true;

        connect();

        new Thread( this ).start(); // fire up main Thread 

    }

    public void sleep(int time)

    {

        try { Thread.sleep(time); }

        catch (Exception e)  {   }

    }

    private void log(String msg)

    {

        flash_msgs[msg_pos++]=msg;

    }

    private void log_(String msg)

    {

        flash_msgs[msg_pos]=msg;

    }

    String url;

    boolean sigfail;

    //    int last_avr_sig;

    public int avr_sig=0;

    public void connect()

    {

        try {

            connection = (StreamConnection) Connector.open(url);

            reader=connection.openInputStream();

            writer=connection.openOutputStream();

        }

        catch (Exception e) {}

    }

    public void close_connections()

    {

        try {

            int foo,leech_cnt=0;

            while (( reader.available() != 0)&&(leech_cnt<1000))

                {

                    leech_cnt++;

                    foo=reader.read();

                }

        }

        catch (Exception e) {}

        //      if ((!force)&&root.canvas.do_vibra) root.vibrate(500);

        try{ reader.close(); }

        catch (Exception inner_ex) { }

        try{ writer.close(); }

        catch (Exception inner_ex) { }

//#ifdef j2me

//#     try{ connection.close(); }

//#     catch (Exception inner_ex) { }

//#endif

    }

    public InputStream in;

    public void run()

    {

        boolean init_sequence=true;    

        int send_buff_size=0;

        int gbl=0;

        log_("attempt:"+attempt);

        while (!got_bl_magic)

            {

                attempt++;

                try{

                    if (init_sequence)

                        {

                            //                      if (attempt!=0)

                            //  sleep((attempt%2==0)?80:800); //800

                            msg_pos=0;

                            flash_msgs[msg_pos++]=("at:"+attempt+" gbl:"+gbl);

                            flash_msgs[msg_pos]=null;

                            if ((attempt%2)==0) // after work

                                {

                                    writer.write('#');

                                    writer.write(0);

                                    writer.write('R');

                                    // CRC

                                    writer.write((char)( (((byte)'#' +0 + (byte)'R')%4096)/64 + '='));

                                    writer.write((char)( (((byte)'#' +0 + (byte)'R')%4096)%64 + '='));

                                    writer.write('\r');

                                    writer.flush();

                                    //sleep(20);

                                }

                            writer.write( 27);

                            writer.flush();

                            sleep(20);

                            writer.write( 0xAA);

                            writer.flush();

                            sleep(180);

                        }

                    //              else

                    //                  sleep(20);

                    init_sequence=true;

                    //              sleep(20);

                    while ( reader.available() > 0 )

                        {

                            if ((byte)reader.read()==bl_magic[bl_magic_pos])

                                {

                                    bl_magic_pos++;

                                    if (bl_magic_pos==bl_magic.length)

                                        {

                                            log("got bl magic");

                                            got_bl_magic=true;

                                            gbl++;

                                            bl_magic_pos=0;

                                            int foo,leech_cnt=0;

                                            while (( reader.available() != 0)&&(leech_cnt<1000))

                                                {

                                                    leech_cnt++;

                                                    foo=reader.read();

                                                }

                                        }

                                }

                            else

                                bl_magic_pos=0;

                        }

                    if (got_bl_magic)

                        {

                            //    sleep(50);

                            flash_msgs[msg_pos++]="reading avr_sig";

                            writer.write( 't');

                            writer.flush();

                            sleep(120);

                            //                      if ( reader.available() == 0 )

                            //throw new Exception("cant read avrsig");

                            /*

                            int sig1_timeout=0;

                            while ( reader.available() == 0)

                                {

                                    if ((sig1_timeout++)>1000 )                    

                                        throw new Exception("cant read avrsig");

                                    sleep(10);

                                }

                            */

                            avr_sig=reader.read();

                            if (avr_sig==63)

                                init_sequence=false;

                            /*    while (avr_sig==63)

                                avr_sig=reader.read();

                            */

                            flash_msgs[msg_pos++]="got avr sig " + avr_sig;

                            //                      last_avr_sig=avr_sig;

                            //                      for(int sig2_timeout=0;sig2_timeout<100;sig2_timeout++)

                            /*

                            int sig2_timeout=0;

                            while ( reader.available() == 0)

                                {

                                    if ((sig2_timeout++)>1000 )                    

                                        throw new Exception("cant read avrsig-val2");

                                    sleep(10);

                                }*/

                            int avrsig_suff=reader.read();

                            if (avrsig_suff!=0)

                                throw new Exception("val after avrsig is" +avrsig_suff +"should b 0");

                            if ((avr_sig!=0x74)&&(avr_sig!=224)&&(avr_sig!=120))

                                {

                                    sigfail=true;

                                    throw new Exception("avr sig" + avr_sig + " unknown");

                                }

                        }

                }

                catch (Exception e)  {

                    log("" + e.getMessage());

                    sleep(1000);

                    exit_bootloader();

                    connect();

                    got_bl_magic=false;

                    init_sequence=false; // after work

                }

            }

        log("have bl-magic & good avrsig" + avr_sig);

            try{

                writer.write('T');

                //              writer.flush();

                writer.write(avr_sig);   // set devicetyp = 0x74 oder 0x76  

                writer.flush();

                if (reader.read()!=0x0d)

                    throw new Exception("cant get buffer size");

                writer.write('V');

                writer.flush();

                int bl_version_major=reader.read();

                int bl_version_minor=reader.read();

                flash_msgs[msg_pos++]="BL Version " + bl_version_major+"."+bl_version_minor;

                writer.write('b');

                writer.flush();

                if (reader.read()!='Y')

                    throw new Exception("cant get buffer size");

                send_buff_size=reader.read()*0x100;

                send_buff_size+=reader.read();

                flash_msgs[msg_pos++]="BUFF Size:" + send_buff_size;

            }

            catch (Exception e2)  {

                exit_bootloader();

                return;

            }

            //              if (send_buff_size>128)

            //      send_buff_size=128;

            switch (intension)

                {

                case MKFirmwareHelper.BOOTLOADER_INTENSION_RESET_PARAMS:

                    try{

                        flash_msgs[msg_pos]="reset params ..";

                        writer.write( MKFirmwareHelper.cmd_reset_params);

                        writer.flush();

                        flash_msgs[msg_pos++]+=" done";

                        success=true;

                    }

                    catch (Exception e2)  {    }       

                    break;

                case MKFirmwareHelper.BOOTLOADER_INTENSION_FLASH_FIRMWARE:

                    try{

                    byte[] flash_buff =new byte[send_buff_size]; ///!!

                    //String firmware_filename=(avr_sig==224)?"/navi.bin":((avr_sig==120)?"/mk3.bin":"/fc.bin");

                    //flash_msgs[msg_pos++]="Opening firmware " + firmware_filename + "..";

                    //InputStream in;

                    //try {

                    //in=this.getClass().getResourceAsStream(firmware_filename);            

                    //  }

                    //  catch (Exception e) {               throw new Exception(" .. cant open firmware");                      }

                    int firmware_size=-1;

                    try {

                        firmware_size= ((int)in.read()<<24) |((int)in.read()<<16) | ((int)in.read()<<8) | ((int)in.read()&0xff) ;

                    }

                    catch (Exception e)

                        {

                            throw new Exception(" .. cant read size");                 

                        }

                    //              in.mark(firmware_size+10);

                    int blocks2write=((firmware_size/send_buff_size))+(((firmware_size%send_buff_size)==0)?0:1);

                    flash_msgs[msg_pos++]=".. open("+blocks2write+" blocks," + firmware_size + "bytes)";

                    //                  if (true) throw new Exception("before erasing");

                    //  if (true) throw new Exception("before erasing" );               

                    flash_msgs[msg_pos++]="Erasing Flash ..";

                    writer.write('e');

                    writer.flush();

                    if (reader.read()!=0x0d)

                        throw new Exception("cant erase flash");

                    flash_msgs[msg_pos]+="OK";

                    writer.write('A');

                    writer.write(0);

                    writer.write(0);

                    writer.flush();

                    if (reader.read()!=0x0d)

                        throw new Exception("cant set addr");

                    flash_msgs[msg_pos++]="addr set";

                    //                  int blocks2write=((firmware_size/send_buff_size));

                    for ( int block=0; block<blocks2write; block ++)

                        {

                            for (int s=0;s<send_buff_size;s++)

                                flash_buff[s]=0;

                            int hex_bytes_read=in.read(flash_buff,0,send_buff_size);

                        /*     

                            if (avr_sig==224)

                            {

                                    for (int s=hex_bytes_read;s<send_buff_size;s++)

                                        flash_buff[s]=0;

                                    hex_bytes_read=send_buff_size; // fix

                                }

                        */

                            hex_bytes_read=send_buff_size; // fix

                            flash_msgs[msg_pos]="bl:" + (block+1) + "/" + blocks2write + " si:"+hex_bytes_read ;

                            writer.write('B');

                            writer.write((hex_bytes_read>>8)& 0xFF);

                            writer.write((hex_bytes_read)& 0xFF);

                            writer.write('F');

                            writer.flush();

                            writer.write(flash_buff,0,hex_bytes_read);

                            writer.flush();                            

                            if (avr_sig==224)

                                {

                                    int crc=0xFFFF;

                                    for (int crc_pos=0;crc_pos<hex_bytes_read;crc_pos++)

                                        crc=MKFirmwareHelper.CRC16(flash_buff[crc_pos],crc);

                                    writer.write((crc>>8)&0xff);

                                    writer.write(crc&0xff);

                                    writer.flush();

                                }

                            //  flash_msgs[msg_pos]+="ok";

                            //                          writer.flush();

                            if (reader.read()!=0x0d)

                                throw new Exception("abort write at block"+block);

                            //                         sleep(1000);

                        } // for block

                    sleep(1000);

                    success=true;

                    }

                    catch (Exception e2)  {  

                    msg_pos++;}

                    break;

                }

            sleep(50);

            exit_bootloader();

            job_done=true;

    }

    public void exit_bootloader()

    {

        try{

            writer.write('E');

            writer.flush();

        }

        catch (Exception e)  {  

            flash_msgs[msg_pos++]="cant exit bootloader" ;

        }

        flash_msgs[msg_pos++]="Exit BL done" ;     

        close_connections();

    }

}