return bpp;
 }
 
+#define GP_ISEL_TPG_MODE 0x90058
+
 #if !defined(HAS_NO_INPUT_SYSTEM) && defined(USE_INPUT_SYSTEM_VERSION_2)
 static enum ia_css_err
 sh_css_config_input_network(struct ia_css_stream *stream) {
                vblank_cycles = vblank_lines * (width + hblank_cycles);
                sh_css_sp_configure_sync_gen(width, height, hblank_cycles,
                                             vblank_cycles);
-               if (pipe->stream->config.mode == IA_CSS_INPUT_MODE_TPG) {
-                       /* TODO: move define to proper file in tools */
-#define GP_ISEL_TPG_MODE 0x90058
-                       ia_css_device_store_uint32(GP_ISEL_TPG_MODE, 0);
+               if (!atomisp_hw_is_isp2401) {
+                       if (pipe->stream->config.mode == IA_CSS_INPUT_MODE_TPG) {
+                               /* TODO: move define to proper file in tools */
+                               ia_css_device_store_uint32(GP_ISEL_TPG_MODE, 0);
+                       }
                }
        }
        ia_css_debug_dtrace(IA_CSS_DEBUG_TRACE_PRIVATE,
         *
         * Only 2401 relevant ??
         */
+#if 0 // FIXME: NOT USED on Yocto Aero
        isys_stream_descr->polling_mode
            = early_polling ? INPUT_SYSTEM_POLL_ON_CAPTURE_REQUEST
              : INPUT_SYSTEM_POLL_ON_WAIT_FOR_FRAME;
        ia_css_debug_dtrace(IA_CSS_DEBUG_TRACE_PRIVATE,
                            "sh_css_translate_stream_cfg_to_isys_stream_descr() leave:\n");
+#endif
 
        return rc;
 }
 
        assert(me); /* all callers are in this file and call with non null argument */
 
-       if (atomisp_hw_is_isp2401) {
+       if (!atomisp_hw_is_isp2401) {
                coord = &me->config.internal_frame_origin_bqs_on_sctbl;
                params = me->stream->isp_params_configs;
        }