HDMITX: Fix and cleanup video mode setup