FreeCalypso > hg > fc-tourmaline
view src/cs/drivers/drv_app/r2d/lcds/r2d_geometry_no2_lcd_i.c @ 303:f76436d19a7a default tip
!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