Как изогнуть изображение?

void WaveDistort(Graphics::TBitmap* src, Graphics::TBitmap* dst, double amp, double freq) {
    src->PixelFormat = pf24bit;
    dst->SetSize(src->Width, src->Height);
    dst->PixelFormat = pf24bit;
 
    for (int y = 0; y < src->Height; y++) {
        BYTE* srcLine = (BYTE*)src->ScanLine[y];
        BYTE* dstLine = (BYTE*)dst->ScanLine[y];
        int shift = (int)(amp * sin(freq * y));
 
        for (int x = 0; x < src->Width; x++) {
            int sx = x - shift;
            if (sx >= 0 && sx < src->Width) {
                dstLine[x*3 + 0] = srcLine[sx*3 + 0];
                dstLine[x*3 + 1] = srcLine[sx*3 + 1];
                dstLine[x*3 + 2] = srcLine[sx*3 + 2];
            } else {
                dstLine[x*3] = dstLine[x*3+1] = dstLine[x*3+2] = 255; // белый фон
            }
        }
    }
}

WaveDistort(originalBitmap, distortedBitmap, 30.0, 0.05);
Image1->Picture->Bitmap = distortedBitmap;

// Предположим: src — исходное изображение (W x H)
// trajectory.size() == src->Height
 
for (int i = 0; i < src->Height; i++) {
    double x = trajectory[i].x;
    double y = trajectory[i].y;
    double theta = trajectory[i].heading;
 
    double cosT = cos(theta);
    double sinT = sin(theta);
 
    // Нормаль (влево от направления движения)
    double nx = -sinT;
    double ny =  cosT;
 
    for (int u = 0; u < src->Width; u++) {
        double local_u = (u - src->Width / 2.0);
        double wx = x + local_u * nx;
        double wy = y + local_u * ny;
 
        int px = (int)(wx - minX + 50);
        int py = (int)((maxY - wy) + 50); // инверсия Y
 
        if (px >= 0 && px < result->Width && py >= 0 && py < result->Height) {
            // Получаем цвет из src->ScanLine[i][u]
            BYTE* srcLine = (BYTE*)src->ScanLine[i];
            BYTE* dstLine = (BYTE*)result->ScanLine[py];
 
            dstLine[px * 3 + 0] = srcLine[u * 3 + 0]; // B
            dstLine[px * 3 + 1] = srcLine[u * 3 + 1]; // G
            dstLine[px * 3 + 2] = srcLine[u * 3 + 2]; // R
        }
    }
}

for (int y = 0; y < y_size_old; ++y) {
  float radius = cntr.y + y;
  float arcLen = radius * angle + 1;  
  for (int x = 0; x < arcLen; ++x) {
   float x_f = x / arcLen;
   float cur_angle = x_f * angle;
   float sinA = sin(cur_angle);
   float cosA = cos(cur_angle);
 
// исходный пиксель
   float x_old = x_f * x_size_old;
   Color color = GetPixelAverage(x_old, y, arcLen / x_size_old);
 
// новый пиксель
   float x1 = 0.0f, y1 = -1.0f;
   float x_new = x1 * cosA - y1 * sinA + cntr.x;
   float y_new = cntr.y - (x1 * sinA + y1 * sinA);
 
   DrawPixel(x_new, y_new, color);
  }
}