- /* Do 64 pixels at a time */
- *((u64*)p_out)++ = ~( *((u64*)p_in)++ );
- *((u64*)p_out)++ = ~( *((u64*)p_in)++ );
- *((u64*)p_out)++ = ~( *((u64*)p_in)++ );
- *((u64*)p_out)++ = ~( *((u64*)p_in)++ );
- *((u64*)p_out)++ = ~( *((u64*)p_in)++ );
- *((u64*)p_out)++ = ~( *((u64*)p_in)++ );
- *((u64*)p_out)++ = ~( *((u64*)p_in)++ );
- *((u64*)p_out)++ = ~( *((u64*)p_in)++ );
- }
-
- p_in_end += 64;
-
- for( ; p_in < p_in_end ; )
- {
- /* Do 1 pixel at a time */
- *p_out++ = ~( *p_in++ );
+ p_line_end = p_in + p_pic->p[i_index].i_visible_pitch - 64;
+
+ for( ; p_in < p_line_end ; )
+ {
+ /* Do 64 pixels at a time */
+ *((uint64_t*)p_out)++ = ~( *((uint64_t*)p_in)++ );
+ *((uint64_t*)p_out)++ = ~( *((uint64_t*)p_in)++ );
+ *((uint64_t*)p_out)++ = ~( *((uint64_t*)p_in)++ );
+ *((uint64_t*)p_out)++ = ~( *((uint64_t*)p_in)++ );
+ *((uint64_t*)p_out)++ = ~( *((uint64_t*)p_in)++ );
+ *((uint64_t*)p_out)++ = ~( *((uint64_t*)p_in)++ );
+ *((uint64_t*)p_out)++ = ~( *((uint64_t*)p_in)++ );
+ *((uint64_t*)p_out)++ = ~( *((uint64_t*)p_in)++ );
+ }
+
+ p_line_end += 64;
+
+ for( ; p_in < p_line_end ; )
+ {
+ *p_out++ = ~( *p_in++ );
+ }
+
+ p_in += p_pic->p[i_index].i_pitch
+ - p_pic->p[i_index].i_visible_pitch;
+ p_out += p_outpic->p[i_index].i_pitch
+ - p_outpic->p[i_index].i_visible_pitch;