попиксельный поворот bitmap

[ijonhson]

Всем доброго времени суток хотел написать функцию которая вращает bitmap вокруг опорной точки,выбрал попиксельный поворот(а не setworldtransform и др. варианты) так как такую функцию будет лего переписать для поворота любого массива точек,но столкнулся с проблемкой,поворачивать поворачивает да вот не так как хотелось,взгляните свежим взглядом может что-то кинется в глаза.
Вот со-но код:
#define min(a, b) (((a) < (b)) ? (a) : (b))
#define max(a, b) (((a) > (b)) ? (a) : (b))
#pragma hdrstop
#include "Unit2.h"
//-----------------------------------------
Graphics::TBitmap* vRotate(int viAngle,int Xop,int Yop,Graphics::TBitmap *pFromBitmap=new Graphics::TBitmap)
{
Graphics::TBitmap *pToBitmap=new Graphics::TBitmap;
int ngXop = (int)(Xop * sin((float)viAngle * M_PI / 180)),
ngYop = (int)(Yop * cos((float)viAngle * M_PI / 180));
int nX = ngXop - Xop,
nY = ngYop - Yop;
pFromBitmap;
float vfRradians=(2*3.1416*viAngle)/360;
float vfCosinus=(float)cos(vfRradians);
float vfSinus=(float)sin(vfRradians);
pToBitmap->Height=pFromBitmap->Height;
pToBitmap->Width=pFromBitmap->Width;
for(int y = 0;y < pToBitmap->Height; y++)
{
for(int x=0;x<pToBitmap->Width;x++)
{
int pFromBitmapx=(int)((x)*vfCosinus+(y )*vfSinus);
int pFromBitmapy=(int)((y)*vfCosinus-(x)*vfSinus);
pFromBitmapx=pFromBitmapx-nX;
pFromBitmapy=pFromBitmapy-nY;
if(pFromBitmapx>=0&&pFromBitmapx<pF romBitmap->Width&&pFromBitmapy>=0&&
pFromBitmapy<pFromBitmap->Height)
{
pToBitmap->Canvas->Pixels[x][y]=
pFromBitmap->Canvas->Pixels[pFromBitmapx][pFromBitmapy];
}
}
}
return pToBitmap;
}
#pragma package(smart_init)

[FataLL]

Поворачиваешь с угла, а надо от центра

[niixon]

А если я хочу поворачивать относительно любой точки? Как правильно реализовать, чтобы все изменения правильно были отображены?