[OMX] Make packet processing in separate functions

This is the first step of trying to push directly packets to OMX