Медианный фильтр

#include "mainwindow.h"
#include "ui_mainwindow.h"
#include <math.h>
#include <QGraphicsSceneMouseEvent>
#include <iostream>
using namespace std;
MainWindow::MainWindow(QWidget *parent) :
    QMainWindow(parent),
    ui(new Ui::MainWindow)
{
    ui->setupUi(this);
    Work();
}
 
//
void bubbleSort(double e[], int size)
{
        int j;
        for (int i = 0; i < size; i++)
        {
                for (j = 0; j < size - 1; j++)
                {
                        if (e[j] > e[j + 1])
                        {
                                int temp = e[j + 1];
                                e[j + 1] = e[j];
                                e[j] = temp;
                        }
 
                }
        }
        for (int h = 0; h < size; h++)
        cout << "Sort :" << e[h] << endl;
}
//
void GrScene::mousePressEvent(QGraphicsSceneMouseEvent *mouseEvent)
{
 QPointF p;
 if (mouseEvent->button() != Qt::LeftButton)
  return;
 p = mouseEvent->scenePos();
 if(Regim==0)
 {OldX=p.x();
 OldY=p.y();
 MouseX=OldX;
 MouseY=OldY;
 Regim=1;
 }
}
 
void GrScene::mouseMoveEvent(QGraphicsSceneMouseEvent *mouseEvent)
{
 QPointF p;
 if(Regim==1)
 {
  p = mouseEvent->scenePos();
  MouseX=p.x();
  MouseY=p.y();
 }
}
void GrScene::mouseReleaseEvent(QGraphicsSceneMouseEvent *mouseEvent)
{
    QPointF p,z;
    if(Regim==1)
    {
        p = mouseEvent->scenePos();
        MouseX=p.x();
        MouseY=p.y();
       Regim=2;
       return;
     }
    if(Regim==2)
    {
        z = mouseEvent->scenePos();
        NewX=z.x();
        NewY=z.y();
           QPainter Spn(&Sqp);
              int i,j,t,t1=0,y,y1=0;
              int w,h;
              QImage im;
              im=Sqp.toImage();
              w = (MouseX - OldX);
              h = (MouseY - OldY);
              QColor px;
              QRgb q;
              int r,g,b;
              QPen pen;
              double arr[10];
              for(i=OldX;i<=OldX+w;i++)
              {
              for(j=OldY;j<=OldY+h;j++)
              {
                  for(int o=0,t=t1;t<t1+4;t++,t1=t1+4)
                  {
                      for (y=y1;y<y1+4;y++,y1=y1+4,o++)
                      {
              q = im.pixel(t,y);
              r = qRed(q);
              g = qGreen(q);
              b = qBlue(q);
              q=0.3*r+0.59*g+0.11*b;
              arr[o]=q;
              }
             }
                  for (int i = 0; i < 9; i++)
                  {
                          cout << arr[i] << ' ';
                  }
                  cout << "\n";
                  bubbleSort(arr, 9);
                  cin.ignore().get();
                  q=arr[4];
                  px.setRgba(q);
                  pen.setColor(px);
                  Spn.setPen(pen);
                  Spn.drawPoint(t,y);
                  }
              }    addPixmap(Sqp);
 
              //
 
 for(i=0;i<=w;i++)
              for(j=0;j<=h;j++)
              {
 
px.setRgba(q);
                pen.setColor(px);
                Spn.setPen(pen);
                Spn.drawPoint(t,y);
              }
                addPixmap(Sqp);
            }
 
    }
 
void MainWindow::Work()
{
    GrScene *sc = new GrScene;
    sc->Regim=0;
 QPixmap qp(ui->graphicsView->size());
 QPainter pn( &qp);
 pn.fillRect( QRect( 0, 0, ui->graphicsView->width() , ui->graphicsView->height()), QBrush( Qt::white ) );
 QPixmap px;
  int w,h;
  QRect r;
  double p;
 px.load("1.jpg");
  w=px.width();
  h=px.height();
  r.setX(10);
  r.setY(20);
  p = h;
  r.setWidth(600);
  int q1=600;
  r.setHeight((int)floor(p / w * r.width()));
  int q2;
  pn.drawPixmap(r,px);
  sc->Sqp=qp;
  sc->addPixmap(qp);
  ui->graphicsView->setScene(sc);
}
MainWindow::~MainWindow()
{
    delete ui;
}

    QVector<QColor> vec;
    int h,w;
    for (h = 1; h < img.height()-1; h++)
    {
        for(w = 1; w < img.width()-1; w++)
        {
            vec.append(QColor(img.pixel(w-1,h-1)));
            vec.append(QColor(img.pixel(w,h-1)));
            vec.append(QColor(img.pixel(w+1,h-1)));
            vec.append(QColor(img.pixel(w-1,h)));
            vec.append(QColor(img.pixel(w,h)));
            vec.append(QColor(img.pixel(w+1,h)));
            vec.append(QColor(img.pixel(w-1,h+1)));
            vec.append(QColor(img.pixel(w,h+1)));
            vec.append(QColor(img.pixel(w+1,h+1)));
 
            qSort(vec.begin(),vec.end());     
            img.setPixel(w,h,vec.at(4).rgb());
            vec.clear();
        }
    }
    pix = QPixmap::fromImage(img);
    label->setPixmap(pix);