网上找的一篇将YUV420SP的转化为RGB565的代码 ,请问大家怎么修改为YUV420->RGB565的呢?我修改的有错误?static public void decodeYUV420P(byte[] rgbBuf, byte[] yuv420p,int width, int height) {
        
        final int frameSize = width * height;
        if (rgbBuf == null)
            throw new NullPointerException("buffer 'rgbBuf' is null");
        if (rgbBuf.length < frameSize * 3)
            throw new IllegalArgumentException("buffer 'rgbBuf' size "
                    + rgbBuf.length + " < minimum " + frameSize * 3);        if (yuv420p == null)
            throw new NullPointerException("buffer 'yuv420p' is null");        if (yuv420p.length < frameSize * 3 / 2)
            throw new IllegalArgumentException("buffer 'yuv420p' size "
                    + yuv420p.length + " < minimum " + frameSize * 3 / 2);        int i = 0, y = 0;
        int uvp = 0, u = 0, v = 0;
        int y1192 = 0, r = 0, g = 0, b = 0;        for (int j = 0, yp = 0; j < height; j++) {
            uvp = frameSize + (j >> 1) * width;
            u = 0;
            v = 0;
            for (i = 0; i < width; i++, yp++) {
                y = (0xff & ((int) yuv420p[yp])) - 16;
                if (y < 0)
                    y = 0;
                if ((i & 1) == 0) {
                    v = (0xff & yuv420p[uvp++]) - 128;
                    u = (0xff & yuv420p[uvp++]) - 128;
                }                y1192 = 1192 * y;
                r = (y1192 + 1634 * v);
                g = (y1192 - 833 * v - 400 * u);
                b = (y1192 + 2066 * u);                if (r < 0)
                    r = 0;
                else if (r > 262143)
                    r = 262143;
                if (g < 0)
                    g = 0;
                else if (g > 262143)
                    g = 262143;
                if (b < 0)
                    b = 0;
                else if (b > 262143)
                    b = 262143;                                rgbBuf[yp * 3] = (byte) (r >> 10);
                rgbBuf[yp * 3 + 1] = (byte) (g >> 10);
                rgbBuf[yp * 3 + 2] = (byte) (b >> 10);
            }
        }
    }