FreeCalypso > hg > fc-tourmaline

view src/cs/drivers/drv_app/r2d/lcds/r2d_geometry_no2_lcd_i.c @ 303:f76436d19a7a default tip

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
!GPRS config: fix long-standing AT+COPS chance hanging bug There has been a long-standing bug in FreeCalypso going back years: sometimes in the AT command bring-up sequence of an ACI-only MS, the AT+COPS command would produce only a power scan followed by cessation of protocol stack activity (only L1 ADC traces), instead of the expected network search sequence. This behaviour was seen in different FC firmware versions going back to Citrine, and seemed to follow some law of chance, not reliably repeatable. This bug has been tracked down and found to be specific to !GPRS configuration, stemming from our TCS2/TCS3 hybrid and reconstruction of !GPRS support that was bitrotten in TCS3.2/LoCosto version. ACI module psa_mms.c, needed only for !GPRS, was missing in the TCS3 version and had to be pulled from TCS2 - but as it turns out, there is a new field in the MMR_REG_REQ primitive that needs to be set correctly, and that psa_mms.c module is the place where this initialization needed to be added.
author Mychaela Falconia <falcon@freecalypso.org>
date Thu, 08 Jun 2023 08:23:37 +0000
parents 4e78acac3d88
children
line wrap: on
line source

#include "rv/general.h"
#include "rvf/rvf_api.h"
#include "r2d/r2d_config.h"
#include "r2d/r2d.h"
#include "r2d/r2d_i.h"
#include "r2d/r2d_independance_layer.h"

#if (R2D_PIXEL_DEPTH == 32)
#define R2D_PIXEL_DOWN_OUT(a) (0)
#define R2D_PIXEL_UP_OUT(a) (0)
#else
#define R2D_PIXEL_DOWN_OUT(a) (a>>R2D_PIXEL_DEPTH)
#define R2D_PIXEL_UP_OUT(a) (a<<R2D_PIXEL_DEPTH)
#endif


#if (R2D_ASM == R2D_ON)
extern void r2d_blit_la(UINT32 *a);
extern void r2d_blit_lb(UINT32 *a);

extern UINT32 r2d_lcd_start_copy;
extern UINT32 r2d_lcd_start_or;
extern UINT32 r2d_lcd_start_and;
extern UINT32 r2d_lcd_start_xor;
extern UINT32 r2d_lcd_start_notcopy;
extern UINT32 r2d_lcd_start_notor;
extern UINT32 r2d_lcd_start_notand;
extern UINT32 r2d_lcd_start_notxor;
extern UINT32 r2d_lcd_start_alpha;
extern UINT32 r2d_lcd_start_erase;
extern UINT32 r2d_lcd_start_foreground_pixel;

extern UINT32 r2d_color_start_copy;
extern UINT32 r2d_color_start_or;
extern UINT32 r2d_color_start_and;
extern UINT32 r2d_color_start_xor;
extern UINT32 r2d_color_start_notcopy;
extern UINT32 r2d_color_start_notor;
extern UINT32 r2d_color_start_notand;
extern UINT32 r2d_color_start_notxor;
extern UINT32 r2d_color_start_alpha;
extern UINT32 r2d_color_start_erase;
extern UINT32 r2d_color_start_foreground_pixel;

extern UINT32 r2d_start_get_color;


// Drawing mode
extern UINT32 r2d_sb_down1;
extern UINT32 r2d_sb_down2;
extern UINT32 r2d_sa_up1;
extern UINT32 r2d_sa_up2;

// Foreground detection
extern UINT32 r2d_sdb_down1;
extern UINT32 r2d_sdb_down2;
extern UINT32 r2d_sda_up1;
extern UINT32 r2d_sda_up2;

// Color conversion
extern UINT32 r2d_scb_down1;
extern UINT32 r2d_scb_down2;
extern UINT32 r2d_sca_up1;
extern UINT32 r2d_sca_up2;

extern UINT32 r2d_start_branch_inst;
extern UINT32 r2d_stop_branch_inst;
extern UINT32 r2d_blit_foreground;
extern UINT32 r2d_blit_background;
extern UINT32 r2d_skip_color_proc_a;
extern UINT32 r2d_end_ynb_color_dst_a;
extern UINT32 r2d_skip_color_proc_b;
extern UINT32 r2d_end_ynb_color_dst_b;

// Patch list for write_shift_pixel_down
extern UINT32 r2d_sft_dst_n_b_down1,r2d_sft_dst_n_b_down2;
extern UINT32 r2d_sft_srcb_n_b_down1,r2d_sft_srcb_n_b_down2;
extern UINT32 r2d_sft_dstc_n_b_down1,r2d_sft_dstc_n_b_down2;

extern UINT32 r2d_sft_src_c_b_down1,r2d_sft_src_c_b_down2;
extern UINT32 r2d_sft_b_c_b_down1,r2d_sft_b_c_b_down2;
extern UINT32 r2d_sft_dstb_c_b_down1,r2d_sft_dstb_c_b_down2;
extern UINT32 r2d_sft_d_c_b_down1,r2d_sft_d_c_b_down2;
extern UINT32 r2d_sft_dstc_c_b_down1,r2d_sft_dstc_c_b_down2;

// Patch list for write_shift_pixel_up
extern UINT32 r2d_sft_dst_n_a_up1,r2d_sft_dst_n_a_up2;
extern UINT32 r2d_sft_srcb_n_a_up1,r2d_sft_srcb_n_a_up2;
extern UINT32 r2d_sft_dstc_n_a_up1,r2d_sft_dstc_n_a_up2;

extern UINT32 r2d_sft_src_c_a_up1,r2d_sft_src_c_a_up2;
extern UINT32 r2d_sft_b_c_a_up1,r2d_sft_b_c_a_up2;

// Patch list fro shift_pixel_down
extern UINT32 r2d_sft_dst_n_downa,r2d_sft_dst_n_downb,r2d_sft_dst_n_downc;
extern UINT32 r2d_sft_srcb_n_downa,r2d_sft_srcb_n_downb,r2d_sft_srcb_n_downc;

extern UINT32 r2d_sft_src_c_downa,r2d_sft_src_c_downb,r2d_sft_src_c_downc;

// Patch list fro shift_pixel_up
extern UINT32 r2d_sft_dst_n_upa,r2d_sft_dst_n_upb,r2d_sft_dst_n_upc;
extern UINT32 r2d_sft_srcb_n_upa,r2d_sft_srcb_n_upb,r2d_sft_srcb_n_upc;

extern UINT32 r2d_sft_src_c_upa,r2d_sft_src_c_upb,r2d_sft_src_c_upc;

extern UINT32 r2d_sconvcolb_down1,r2d_econvcolb_down1;
extern UINT32 r2d_sconvcolb_down2,r2d_econvcolb_down2;
extern UINT32 r2d_sconvcola_up1,r2d_econvcola_up1;
extern UINT32 r2d_sconvcola_up2,r2d_econvcola_up2;
extern UINT32 r2d_start_lcd_to_color,r2d_start_color_to_lcd;

extern UINT32 r2d_always_write_down,r2d_always_write_up,r2d_never_write;
extern UINT32 r2d_swb_down1,r2d_swb_down2,r2d_swa_up1,r2d_swa_up2;

extern UINT32 r2d_skip_color_dst_a,r2d_skip_color_dst_b;
extern UINT32 r2d_always_skip;
extern UINT32 r2d_enda,r2d_endb;
extern UINT32 r2d_lcd_start_nothing;

UINT32* r2d_g_asm_lcd_operators[]=
{
   &r2d_lcd_start_copy,
   &r2d_lcd_start_or,
   &r2d_lcd_start_and,
   &r2d_lcd_start_xor,
   &r2d_lcd_start_notcopy,
   &r2d_lcd_start_notor,
   &r2d_lcd_start_notand,
   &r2d_lcd_start_notxor,
   &r2d_lcd_start_alpha,
   &r2d_lcd_start_erase
};

UINT32* r2d_g_asm_color_operators[]=
{
   &r2d_color_start_copy,
   &r2d_color_start_or,
   &r2d_color_start_and,
   &r2d_color_start_xor,
   &r2d_color_start_notcopy,
   &r2d_color_start_notor,
   &r2d_color_start_notand,
   &r2d_color_start_notxor,
   &r2d_color_start_alpha,
   &r2d_color_start_erase
};


extern void r2d_patch_color_conversion(T_R2D_GC_PTR gc);
extern void r2d_patch_shift(UINT32 *src,UINT32 shift);
extern void r2d_patch_branch(UINT32 *src,UINT32 *dst,BOOLEAN f);
extern void r2d_patch_get_color(UINT32* src,UINT32 *dst);
extern void r2d_patch_inst(UINT32* src,UINT32 *dst);
extern void r2d_patch_code_block(UINT32* src,UINT32 *dst);

extern void r2d_check_rectangle_overlap(INT16 src_x,INT16 src_y,INT16 dst_x,INT16 dst_y,
INT32 width,INT32 height,
INT32 *h_direction,INT32 *v_direction);

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

  R2D ASM MODE

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


// Requires shapes in graphic context coordinates
void           r2d_blit_asm(T_R2D_GC_PTR src_gc,T_R2D_GC_PTR dst_gc,
                             T_R2D_SHAPE_PTR src_rectangle, 
							 T_R2D_SHAPE_PTR dst_rectangle,
							 R2D_BOOLEAN use_foreground_color,INT32 srcdst)
{
    T_R2D_GC_PTR local_src_gc,local_dst_gc;
    UINT32 *p_src,*p_dst,*p_src_current,*p_dst_current,*p_src_start,*p_dst_start;
    INT16 rect_width,rect_height,src_x,src_y,dst_x,dst_y;
    INT16 src_offset,dst_offset,src_height,dst_height;
    INT16 xnb,ynb,src_nb_rows,dst_nb_rows;
    INT16 src_dy,dst_dy,end_dst_dy,end_src_dy; // distance from word boundary
    INT16 shift; // relative position (modulo a memory word) between both rectangles
    // in bits 
    INT16 current_src_dy,current_dst_dy;
    INT16 temp,dstcounter,srccounter;


    UINT32 dstvalue,dst_current;
    UINT32 srcvalue,src_current;
    INT32  h_direction,v_direction;
	INT16 x,y;
	BOOLEAN compensate;
    UINT32* code_dest;
    UINT32* code_src;

    compensate=TRUE;

    // Copy argument to local ones for enabling asm access
   
    local_src_gc=src_gc;
    local_dst_gc=dst_gc;

    
    

    {

    p_src=((T_R2D_FRAMEBUFFER*)(((T_R2D_GC*)src_gc)->p_frame_buffer))->p_memory_words;
    p_dst=((T_R2D_FRAMEBUFFER*)(((T_R2D_GC*)dst_gc)->p_frame_buffer))->p_memory_words;

    rect_width=r2d_get_xmax(src_rectangle)-r2d_get_xmin(src_rectangle);
    rect_height=r2d_get_ymax(src_rectangle)-r2d_get_ymin(src_rectangle);

    
    if ((rect_width<=0) || (rect_height<=0))
		goto end_blit_b;
    
    src_x=r2d_get_xmin(src_rectangle);
    src_y=r2d_get_ymin(src_rectangle);

    dst_x=r2d_get_xmin(dst_rectangle);
    dst_y=r2d_get_ymin(dst_rectangle);

    if ((srcdst==R2D_LCDLCD) || (srcdst==R2D_LCDCOLOR))
       src_dy=(src_y & R2D_WORD_POSITION_MASK);
    else
       src_dy=0;

    if ((srcdst==R2D_LCDLCD) || (srcdst==R2D_COLORLCD))
	  dst_dy=(dst_y & R2D_WORD_POSITION_MASK);
    else
      dst_dy=0;
	
    // Clipping convention such end_dst_dy is the first y position which must not
    // be copied at the end of a column
    //printf("dest y max=%d\n",r2d_get_ymax(dst_rectangle));
    if ((srcdst==R2D_LCDLCD) || (srcdst==R2D_COLORLCD))
       end_dst_dy=((r2d_get_ymax(dst_rectangle)-1) & R2D_WORD_POSITION_MASK) ;
	else
       end_dst_dy=0;

    if ((srcdst==R2D_LCDLCD) || (srcdst==R2D_LCDCOLOR))
       end_src_dy=((r2d_get_ymax(src_rectangle)-1) & R2D_WORD_POSITION_MASK) ;
	else
       end_src_dy=0;

    //printf("dst_dy, end_dst_dy before reverse=%d,%d\n",dst_dy,end_dst_dy);
    // Number of rows is word containing last point - word containing first point
    // + 1

    // We remove - 1 because last PIXEL is at 1 from the frontier line
    if ((srcdst==R2D_LCDLCD) || (srcdst==R2D_COLORLCD))
       dst_nb_rows=R2D_ALIGNED_MWLENGTH(r2d_get_ymax(dst_rectangle)-1)-R2D_ALIGNED_MWLENGTH(dst_y)+1;
    else
       dst_nb_rows=r2d_get_ymax(dst_rectangle)-1-dst_y+1;

    if ((srcdst==R2D_LCDCOLOR) || (srcdst==R2D_LCDLCD))
      src_nb_rows=R2D_ALIGNED_MWLENGTH(r2d_get_ymax(src_rectangle)-1)-R2D_ALIGNED_MWLENGTH(src_y)+1;
    else
      src_nb_rows=r2d_get_ymax(src_rectangle)-1-src_y+1;

    //printf("src_nb_rows %d\n",src_nb_rows);
    //printf("dst_nb_rows %d\n",dst_nb_rows);

    
    h_direction=1;
    v_direction=1;
    if (((T_R2D_FRAMEBUFFER*)(((T_R2D_GC*)src_gc)->p_frame_buffer))==
       ((T_R2D_FRAMEBUFFER*)(((T_R2D_GC*)dst_gc)->p_frame_buffer)))
      r2d_check_rectangle_overlap(src_x,src_y,dst_x,dst_y,
      rect_width,rect_height,&h_direction,&v_direction);

    //printf("h,v=%d,%d\n",h_direction,v_direction);


#if (R2D_REFRESH == R2D_VERTICAL)      
      src_height=((T_R2D_FRAMEBUFFER*)(((T_R2D_GC*)src_gc)->p_frame_buffer))->height;
      dst_height=((T_R2D_FRAMEBUFFER*)(((T_R2D_GC*)dst_gc)->p_frame_buffer))->height;
#else
	  src_height=((T_R2D_FRAMEBUFFER*)(((T_R2D_GC*)src_gc)->p_frame_buffer))->width;
      dst_height=((T_R2D_FRAMEBUFFER*)(((T_R2D_GC*)dst_gc)->p_frame_buffer))->width;
#endif

      if ((srcdst==R2D_LCDCOLOR) || (srcdst==R2D_LCDLCD))
	     src_offset=R2D_ALIGNED_MWLENGTH(src_height);
      else
	     src_offset=src_height;

      if ((srcdst==R2D_LCDLCD) || (srcdst==R2D_COLORLCD))
         dst_offset=R2D_ALIGNED_MWLENGTH(dst_height);
      else
         dst_offset=dst_height;


      //printf("%08X,dst offset=%08X\n",p_dst,dst_offset);

      if ((srcdst==R2D_LCDCOLOR) || (srcdst==R2D_LCDLCD))
         p_src_start=p_src
           +((src_x*src_offset+(src_y>>R2D_PIXELS_PER_MEMORY_WORD)));
      else
         p_src_start=p_src
           +((src_x*src_offset+(src_y)));

      if ((srcdst==R2D_LCDLCD) || (srcdst==R2D_COLORLCD))
        p_dst_start=p_dst
           +((dst_x*dst_offset+(dst_y>>R2D_PIXELS_PER_MEMORY_WORD)));
      else
        p_dst_start=p_dst
           +((dst_x*dst_offset+(dst_y)));

      xnb=rect_width;

      //printf("src start %08X contains %08X\n",p_src_start,*p_src_start);
      //printf("dst start %08X contains %08X\n",p_dst_start,*p_dst_start);

      //printf("rect_width %d\n",rect_width);
      if (h_direction==-1)
      {
		x=r2d_get_xmax(dst_rectangle)-1;
        p_src_start+=(rect_width-1)*src_offset;
        p_dst_start+=(rect_width-1)*dst_offset;
      }
	  else
         x=r2d_get_xmin(dst_rectangle);

      //printf("src start %08X contains %08X\n",p_src_start,*p_src_start);
      //printf("dst start %08X contains %08X\n",p_dst_start,*p_dst_start);

      if (v_direction==-1)
      {
        p_src_start+=src_nb_rows-1;
        p_dst_start+=dst_nb_rows-1;

        temp=src_dy;
        src_dy=end_src_dy;
        end_src_dy=temp;

        temp=dst_dy;
        dst_dy=end_dst_dy;
        end_dst_dy=temp;
      }


      //printf("src start %08X contains %08X\n",p_src_start,*p_src_start);
      //printf("dst start %08X contains %08X\n",p_dst_start,*p_dst_start);

      //printf("dst_start=%08X contains %08X\n",p_dst_start,*p_dst_start);
      while(xnb!=0)
      {
        p_dst_current=p_dst_start;
        p_src_current=p_src_start;

        //printf("xnb=%d\n",xnb);
        //printf("src start %08X contains %08X\n",p_src_start,*p_src_start);
        //printf("dst start %08X contains %08X\n",p_dst_start,*p_dst_start);


        if ((srcdst==R2D_COLORCOLOR) || (srcdst==R2D_LCDCOLOR))
           ynb=dst_nb_rows;
        else
           ynb=dst_nb_rows-1; // no -1 when dest is R2D color
        
        if (v_direction==-1)
        {
		   y=r2d_get_ymax(dst_rectangle) - 1;
           if ((srcdst==R2D_LCDLCD) || (srcdst==R2D_LCDCOLOR))
               current_src_dy=(1<<R2D_PIXELS_PER_MEMORY_WORD)-1;
           else
               current_src_dy=0;

           if ((srcdst==R2D_LCDLCD) || (srcdst==R2D_COLORLCD))
               current_dst_dy=(1<<R2D_PIXELS_PER_MEMORY_WORD)-1;
           else
               current_dst_dy=0;
        }
        else
        {
           current_src_dy=0;
           current_dst_dy=0;
		   y=r2d_get_ymin(dst_rectangle);
        }
        
        dstcounter=(1<<R2D_PIXELS_PER_MEMORY_WORD);
        srccounter=(1<<R2D_PIXELS_PER_MEMORY_WORD);
        
        dst_current=*p_dst_current;
        src_current=*p_src_current;
        //printf("src_current=%08X, dst_current=%08X\n",src_current,dst_current);
        temp=0;
        //printf("new column\n dst=%08X\n",p_dst_current);
        //printf("current_dst_dy =%d, dst_dy=%d\n",current_dst_dy,dst_dy);
        dstvalue=0;

		if (v_direction==-1)
		  r2d_blit_la((UINT32*)&local_src_gc);
        else
          r2d_blit_lb((UINT32*)&local_src_gc);

		

        
        dstvalue=0;
        
          
        if (h_direction==-1)
        {
          p_src_start-=src_offset;
          p_dst_start-=dst_offset;
		  x--;
        }
        else
        {
          p_src_start+=src_offset;
          p_dst_start+=dst_offset;
		  x++;
        }

        xnb--;
      }

      
      
    
  }
end_blit_b:dstvalue=0;
}
#endif