Astromatic - public software.sextractor - Blame - Rev 267

[/] [branches/] [multi/] [src/] [psf.c] - Blame information for rev 267

Go to most recent revision | Details | Compare with Previous | View Log


/*
*                               psf.c
*
* Fit a PSF model to an image.
*
*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
*
*       This file part of:      SExtractor
*
*       Copyright:              (C) 1998-2011 Emmanuel Bertin -- IAP/CNRS/UPMC
*
*       License:                GNU General Public License
*
*       SExtractor is free software: you can redistribute it and/or modify
*       it under the terms of the GNU General Public License as published by
*       the Free Software Foundation, either version 3 of the License, or
*       (at your option) any later version.
*       SExtractor is distributed in the hope that it will be useful,
*       but WITHOUT ANY WARRANTY; without even the implied warranty of
*       MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
*       GNU General Public License for more details.
*       You should have received a copy of the GNU General Public License
*       along with SExtractor. If not, see <http://www.gnu.org/licenses/>.
*
*       Last modified:          06/10/2011
*
*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
 
#ifdef HAVE_CONFIG_H
#include        "config.h"
#endif
 
#include        <math.h>
#include        <stdio.h>
#include        <stdlib.h>
#include        <string.h>
 
#include        "define.h"
#include        "globals.h"
#include        "prefs.h"
#include        "fits/fitscat.h"
#include        "check.h"
#include        "field.h"
#include        "filter.h"
#include        "image.h"
#include        "wcs/poly.h"
#include        "psf.h"
 
/*------------------------------- variables ---------------------------------*/
 
 
extern keystruct        objkey[];
extern objstruct        outobj;
 
/********************************* psf_init **********************************/
/*
Allocate memory and stuff for the PSF-fitting.
*/
void    psf_init(psfstruct *psf)
  {
  QMALLOC(thepsfit, psfitstruct, 1);
  QMALLOC(thepsfit->x, double, prefs.psf_npsfmax);
  QMALLOC(thepsfit->y, double, prefs.psf_npsfmax);
  QMALLOC(thepsfit->flux, float, prefs.psf_npsfmax);
  QMALLOC(thepsfit->fluxerr, float, prefs.psf_npsfmax);
  QMALLOC(ppsfit, psfitstruct, 1); /*?*/
  QMALLOC(ppsfit->x, double, prefs.psf_npsfmax);
  QMALLOC(ppsfit->y, double, prefs.psf_npsfmax);
  QMALLOC(ppsfit->flux, float, prefs.psf_npsfmax);
  QMALLOC(ppsfit->fluxerr, float, prefs.psf_npsfmax);
 
  return;
  }
 
 
/********************************* psf_end ***********************************/
/*
Free memory occupied by the PSF-fitting stuff.
*/
void    psf_end(psfstruct *psf, psfitstruct *psfit)
  {
   int  d, ndim;
 
  ndim = psf->poly->ndim;
  for (d=0; d<ndim; d++)
    free(psf->contextname[d]);
  free(psf->context);
  free(psf->contextname);
  free(psf->contextoffset);
  free(psf->contextscale);
  free(psf->contexttyp);
  poly_end(psf->poly);
  free(psf->maskcomp);
  free(psf->maskloc);
  free(psf->masksize);
  free(psf);
 
  if (psfit)
    {
    free(psfit->x);
    free(psfit->y);
    free(psfit->flux);
    free(psfit->fluxerr);
    free(psfit);
    }
 
  return;
  }
 
 
/********************************* psf_load *********************************/
/*
Read the PSF data from a FITS file.
*/
psfstruct       *psf_load(char *filename)
  {
   static obj2struct    saveobj2;
   psfstruct            *psf;
   catstruct            *cat;
   tabstruct            *tab;
   keystruct            *key;
   char                 *head, *ci,*co;
   int                  deg[POLY_MAXDIM], group[POLY_MAXDIM], ndim, ngroup,
                        i,k;
 
/* Open the cat (well it is not a "cat", but simply a FITS file */
  if (!(cat = read_cat(filename)))
    error(EXIT_FAILURE, "*Error*: PSF file not found: ", filename);
 
/* OK, we now allocate memory for the PSF structure itself */
  QCALLOC(psf, psfstruct, 1);
 
/* Store a short copy of the PSF filename */
  if ((ci=strrchr(filename, '/')))
    strcpy(psf->name, ci+1);
  else
    strcpy(psf->name, filename);
 
  if (!(tab = name_to_tab(cat, "PSF_DATA", 0)))
    error(EXIT_FAILURE, "*Error*: PSF_DATA table not found in catalog ",
        filename);
 
  head = tab->headbuf;
 
/*-- Dimension of the polynomial */
  if (fitsread(head, "POLNAXIS", &ndim, H_INT,T_LONG) == RETURN_OK
        && ndim)
    {
/*-- So we have a polynomial description of the PSF variations */
    if (ndim > POLY_MAXDIM)
        {
        sprintf(gstr, "*Error*: The POLNAXIS parameter in %s exceeds %d",
                psf->name, POLY_MAXDIM);
        error(EXIT_FAILURE, gstr, "");
        }
 
    QMALLOC(psf->contextname, char *, ndim);
    QMALLOC(psf->context, double *, ndim);
    QMALLOC(psf->contexttyp, t_type, ndim);
    QMALLOC(psf->contextoffset, double, ndim);
    QMALLOC(psf->contextscale, double, ndim);
 
/*-- We will have to use the flagobj2 struct, so we first save its content */
    saveobj2 = flagobj2;
/*-- flagobj2 is used as a FLAG array, so we initialize it to 0 */
    memset(&flagobj2, 0, sizeof(flagobj2));
    for (i=0; i<ndim; i++)
      {
/*---- Polynomial groups */
      sprintf(gstr, "POLGRP%1d", i+1);
      if (fitsread(head, gstr, &group[i], H_INT,T_LONG) != RETURN_OK)
        goto headerror;
 
/*---- Contexts */
      QMALLOC(psf->contextname[i], char, 80);
      sprintf(gstr, "POLNAME%1d", i+1);
      if (fitsread(head,gstr,psf->contextname[i],H_STRING,T_STRING)!=RETURN_OK)
        goto headerror;
      if (*psf->contextname[i]==(char)':')
/*------ It seems we're facing a FITS header parameter */
        psf->context[i] = NULL; /* This is to tell we'll have to load */
                                /* a FITS header context later on */
      else
/*------ The context element is a dynamic object parameter */
        {
        if ((k = findkey(psf->contextname[i], (char *)objkey,
                sizeof(keystruct)))==RETURN_ERROR)
          {
          sprintf(gstr, "*Error*: %s CONTEXT parameter in %s unknown",
                psf->contextname[i], psf->name);
          error(EXIT_FAILURE, gstr, "");
          }
        key = objkey+k;
        psf->context[i] = key->ptr;
        psf->contexttyp[i] = key->ttype;
/*------ Declare the parameter "active" to trigger computation by SExtractor */
        *((char *)key->ptr) = (char)'\1';
        }
/*---- Scaling of the context parameter */
      sprintf(gstr, "POLZERO%1d", i+1);
      if (fitsread(head, gstr, &psf->contextoffset[i], H_EXPO, T_DOUBLE)
                !=RETURN_OK)
        goto headerror;
      sprintf(gstr, "POLSCAL%1d", i+1);
      if (fitsread(head, gstr, &psf->contextscale[i], H_EXPO, T_DOUBLE)
                !=RETURN_OK)
        goto headerror;
      }
 
/*-- Number of groups */
    if (fitsread(head, "POLNGRP ", &ngroup, H_INT, T_LONG) != RETURN_OK)
      goto headerror;
 
    for (i=0; i<ngroup; i++)
      {
/*---- Polynomial degree for each group */
      sprintf(gstr, "POLDEG%1d", i+1);
      if (fitsread(head, gstr, &deg[i], H_INT,T_LONG) != RETURN_OK)
        goto headerror;
      }
 
    psf->poly = poly_init(group, ndim, deg, ngroup);
 
/*-- Restore previous flagobj2 content */
    flagobj2 = saveobj2;
    }
  else
    {
/*-- This is a simple, constant PSF */
    psf->poly = poly_init(group, 0, deg, 0);
    psf->context = NULL;
    }
 
/* Dimensionality of the PSF mask */
  if (fitsread(head, "PSFNAXIS", &psf->maskdim, H_INT, T_LONG) != RETURN_OK)
    goto headerror;
  if (psf->maskdim<2 || psf->maskdim>3)
    error(EXIT_FAILURE, "*Error*: wrong dimensionality for the PSF "
        "mask in ", filename);
  QMALLOC(psf->masksize, int, psf->maskdim);
  for (i=0; i<psf->maskdim; i++)
    psf->masksize[i] = 1;
  psf->masknpix = 1;
  for (i=0; i<psf->maskdim; i++)
    {
    sprintf(gstr, "PSFAXIS%1d", i+1);
    if (fitsread(head, gstr, &psf->masksize[i], H_INT,T_LONG) != RETURN_OK)
      goto headerror;
    psf->masknpix *= psf->masksize[i];
    }
 
/* PSF FWHM: defaulted to 3 pixels */
 if (fitsread(head, "PSF_FWHM", &psf->fwhm, H_FLOAT,T_DOUBLE) != RETURN_OK)
    psf->fwhm = 3.0;
 
/* PSF oversampling: defaulted to 1 */
  if (fitsread(head, "PSF_SAMP", &psf->pixstep,H_FLOAT,T_FLOAT) != RETURN_OK
        || psf->pixstep <= 0.0)
    psf->pixstep = 1.0;
 
/* Load the PSF mask data */
  key = read_key(tab, "PSF_MASK");
  psf->maskcomp = key->ptr;
 
  QMALLOC(psf->maskloc, float, psf->masksize[0]*psf->masksize[1]);
 
/* But don't touch my arrays!! */
  blank_keys(tab);
 
  free_cat(&cat, 1);
 
  return psf;
 
headerror:
  error(EXIT_FAILURE, "*Error*: Incorrect or obsolete PSF data in ", filename);
  return NULL;
  }
 
 
/***************************** psf_readcontext *******************************/
/*
Read the PSF context parameters in the FITS header.
*/
void    psf_readcontext(psfstruct *psf, picstruct *field)
  {
   static double        contextval[POLY_MAXDIM];
   int                  i, ndim;
 
  ndim = psf->poly->ndim;
  for (i=0; i<ndim; i++)
    if (!psf->context[i])
      {
      psf->context[i] = &contextval[i];
      psf->contexttyp[i] = T_DOUBLE;
      if (fitsread(field->tab->headbuf, psf->contextname[i]+1, &contextval[i],
                H_FLOAT,T_DOUBLE) == RETURN_ERROR)
        {
        sprintf(gstr, "*Error*: %s parameter not found in the header of ",
                psf->contextname[i]+1);
        error(EXIT_FAILURE, gstr, field->rfilename);
        }
      }
 
  return;
  }
 
 
/******************************** psf_fit ***********************************/
/*                   standard PSF fit for one component                     */
/****************************************************************************/
 
void    psf_fit(psfstruct *psf, picstruct *field, picstruct *wfield,
                obj2struct *obj2)
{
  checkstruct           *check;
  static double x2[PSF_NPSFMAX],y2[PSF_NPSFMAX],xy[PSF_NPSFMAX],
                        deltax[PSF_NPSFMAX],
                        deltay[PSF_NPSFMAX],
                        flux[PSF_NPSFMAX],fluxerr[PSF_NPSFMAX],
                        deltaxb[PSF_NPSFMAX],deltayb[PSF_NPSFMAX],
                        fluxb[PSF_NPSFMAX],fluxerrb[PSF_NPSFMAX],
                        sol[PSF_NTOT], covmat[PSF_NTOT*PSF_NTOT],
                        vmat[PSF_NTOT*PSF_NTOT], wmat[PSF_NTOT];
  float                 *data, *data2, *data3, *weight, *d, *w;
  double                *mat,
                        *m, *var,
                        dx,dy,
                        pix,pix2, wthresh,val,
                        backnoise2, gain, radmin2,radmax2,satlevel,chi2,
                        r2, valmax, psf_fwhm;
  float                 **psfmasks, **psfmaskx,**psfmasky,
                        *ps, *dh, *wh, pixstep;
  PIXTYPE               *datah, *weighth;
  int                   i,j,p, npsf,npsfmax, npix, nppix, ix,iy,niter,
                        width, height, pwidth,pheight, x,y,
                        xmax,ymax, wbad, gainflag, convflag, npsfflag,
                        ival,kill=0;
 
  dx = dy = 0.0;
  niter = 0;
  npsfmax = prefs.psf_npsfmax;
  pixstep = 1.0/psf->pixstep;
  gain = (field->gain >0.0? field->gain: 1e30);
  backnoise2 = field->backsig*field->backsig;
  satlevel = field->satur_level - obj2->bkg;
  wthresh = wfield?wfield->weight_thresh:BIG;
  gainflag = prefs.weightgain_flag;
  psf_fwhm = psf->fwhm*psf->pixstep;
 
 
  /* Initialize outputs */
  thepsfit->niter = 0;
  thepsfit->npsf = 0;
  for (j=0; j<npsfmax; j++)
    {
      thepsfit->x[j] = obj2->posx;
      thepsfit->y[j] = obj2->posy;
      thepsfit->flux[j] = 0.0;
      thepsfit->fluxerr[j] = 0.0;
    }
 
  /* Scale data area with object "size" */
  ix = (obj2->xmax+obj2->xmin+1)/2;
  iy = (obj2->ymax+obj2->ymin+1)/2;
  width = obj2->xmax-obj2->xmin+1+psf_fwhm;
  if (width < (ival=(int)(psf_fwhm*2)))
    width = ival;
  height = obj2->ymax-obj2->ymin+1+psf_fwhm;
  if (height < (ival=(int)(psf_fwhm*2)))
    height = ival;
  npix = width*height;
  radmin2 = PSF_MINSHIFT*PSF_MINSHIFT;
  radmax2 = npix/2.0;
 
  /* Scale total area with PSF FWHM */
  pwidth = (int)(psf->masksize[0]*psf->pixstep)+width;;
  pheight = (int)(psf->masksize[1]*psf->pixstep)+height;
  nppix = pwidth*pheight;
 
  QMALLOC(weighth, PIXTYPE, npix);
  QMALLOC(weight, float, npix);
  QMALLOC(datah, PIXTYPE, npix);
  QMALLOC(data, float, npix);
  QMALLOC(data2, float, npix);
  QMALLOC(data3, float, npix);
  QMALLOC(mat, double, npix*PSF_NTOT);
  if (prefs.check[CHECK_SUBPSFPROTOS] || prefs.check[CHECK_PSFPROTOS])
    {
      QMALLOC(checkmask, PIXTYPE, nppix);
    }
 
  QMALLOC(psfmasks, float *, npsfmax);
  QMALLOC(psfmaskx, float *, npsfmax);
  QMALLOC(psfmasky, float *, npsfmax);
  for (i=0; i<npsfmax; i++)
    {
      QMALLOC(psfmasks[i], float, npix);
      QMALLOC(psfmaskx[i], float, npix);
      QMALLOC(psfmasky[i], float, npix);
    }
 
  /* Compute weights */
  wbad = 0;
  if (wfield)
    {
    psf_copyobjpix(datah, weighth, width, height, ix,iy, obj2,
                !(field->flags&MEASURE_FIELD));
    for (wh=weighth, w=weight, dh=datah,p=npix; p--;)
      if ((pix=*(wh++)) < wthresh && pix>0
        && (pix2=*(dh++))>-BIG
        && pix2<satlevel)
        *(w++) = 1/sqrt(pix+(pix2>0.0?
                        (gainflag? pix2*pix/backnoise2:pix2)/gain
                        :0.0));
        else
          {
          *(w++) = 0.0;
          wbad++;
          }
    }
  else
    {
    psf_copyobjpix(datah, NULL, width, height, ix,iy, obj2,
                !(field->flags&MEASURE_FIELD));
    for (w=weight, dh=datah, p=npix; p--;)
      if ((pix=*(dh++))>-BIG && pix<satlevel)
        *(w++) = 1.0/sqrt(backnoise2+(pix>0.0?pix/gain:0.0));
      else
        {
          *(w++) = 0.0;
          wbad++;
        }
    }
 
  /* Special action if most of the weights are zero!! */
  if (wbad>=npix-3)
    return;
 
  /* Weight the data */
  dh = datah;
  val = obj2->dbkg;      /* Take into account a local background change */
  d = data;
  w = weight;
  for (p=npix; p--;)
    *(d++) = (*(dh++)-val)**(w++);
 
  /* Get the local PSF */
  psf_build(psf, obj2);
 
  npsfflag = 1;
  r2 = psf_fwhm*psf_fwhm/2.0;
  fluxb[0] = fluxerrb[0] = deltaxb[0] = deltayb[0] = 0.0;
 
  for (npsf=1; npsf<=npsfmax && npsfflag; npsf++)
    {
      kill=0;
/*-- First compute an optimum initial guess for the positions of components */
      if (npsf>1)
        {
/*---- Subtract previously fitted components */
          d = data2;
          dh = datah;
          for (p=npix; p--;)
            *(d++) = (double)*(dh++);
          for (j=0; j<npsf-1; j++)
            {
              d = data2;
              ps = psfmasks[j];
              for (p=npix; p--;)
                *(d++) -= flux[j]**(ps++);
            }
          convolve_image(field, data2, data3, width,height);
/*---- Ignore regions too close to stellar cores */
          for (j=0; j<npsf-1; j++)
            {
              d = data3;
              dy = -((double)(height/2)+deltay[j]);
              for (y=height; y--; dy += 1.0)
                {
                  dx = -((double)(width/2)+deltax[j]);
                  for (x=width; x--; dx+= 1.0, d++)
                    if (dx*dx+dy*dy<r2)
                      *d = -BIG;
                }
            }
/*---- Now find the brightest pixel (poor man's guess, to be refined later) */
          d = data3;
          valmax = -BIG;
          xmax = width/2;
          ymax = height/2;
          for (y=0; y<height; y++)
            for (x=0; x<width; x++)
              {
                if ((val = *(d++))>valmax)
                  {
                    valmax = val;
                    xmax = x;
                    ymax = y;
                  }
              }
          deltax[npsf-1] = (double)(xmax - width/2);
          deltay[npsf-1] = (double)(ymax - height/2);
        }
      else
        {
/*---- Only one component to fit: simply use the barycenter as a guess */
          deltax[npsf-1] = obj2->mx - ix;
          deltay[npsf-1] = obj2->my - iy;
        }
 
      niter = 0;
      convflag = 1;
      for (i=0; i<PSF_NITER && convflag; i++)
        {
          convflag = 0,niter++,m=mat;
          for (j=0; j<npsf; j++)
            {
/*------ Resample the PSFs here for the 1st iteration */
              vignet_resample(psf->maskloc, psf->masksize[0], psf->masksize[1],
                              psfmasks[j], width, height,
                              -deltax[j]*pixstep, -deltay[j]*pixstep,
                              pixstep);
              m=compute_gradient(weight,width,height,
                                 psfmasks[j],psfmaskx[j],psfmasky[j],m);
            }
 
 
          svdfit(mat, data, npix, npsf*PSF_NA, sol, vmat, wmat);
 
          compute_pos( &npsf, &convflag, &npsfflag,radmin2,radmax2,
                       r2, sol,flux, deltax, deltay,&dx,&dy);
        }
 
/*-- Compute variances and covariances */
      svdvar(vmat, wmat, npsf*PSF_NA, covmat);
      var = covmat;
      for (j=0; j<npsf; j++, var += (npsf*PSF_NA+1)*PSF_NA)
        {
/*---- First, the error on the flux estimate */
          fluxerr[j] = sqrt(*var)>0.0?  sqrt(*var):999999.0;
          //if (flux[j]<12*fluxerr && j>0)
          //  npsfmax--,flux[j]=0;
          if (flux[j]<12*fluxerr[j] && j>0)
                 {
                   flux[j]=0,kill++,npsfmax--;
                   //if(j==npsfmax-1)
                   //  kill++;             
                 }
        }
      if (npsfflag)
        {
/*--- If we reach this point we know the data are worth backuping */
          for (j=0; j<npsf; j++)
            {
              deltaxb[j] = deltax[j];
              deltayb[j] = deltay[j];
              fluxb[j] = flux[j];
              fluxerrb[j]=fluxerr[j];
            }
        }
    }
  npsf=npsf-1-kill;
 
/* Now keep only fitted stars that fall within the current detection area */
  i = 0;
  for (j=0; j<npsf; j++)
    {
      x = (int)(deltaxb[j]+0.4999)+width/2;
      y = (int)(deltayb[j]+0.4999)+height/2;
      if (x<0 || x>=width || y<0 || y>=height)
        continue;
      if (weight[y*width+x] < 1/BIG)
        continue;
      if (10*fluxb[j]<fluxb[0] )
        continue;
      if (fluxb[j]<=0 )
        continue;
 
      if (FLAG(obj2.poserrmx2_psf))
        compute_poserr(j,covmat,sol,obj2,x2,y2,xy, npsf);
 
      deltax[i] = deltaxb[j];
      deltay[i] = deltayb[j];
      flux[i] = fluxb[j];
      fluxerr[i++] = fluxerrb[j];
    }
 
  npsf = i;
 
  /* Compute chi2 if asked to
  if (FLAG(obj2.chi2_psf))
    {
      for (j=0; j<npsf; j++)
        {
          chi2 = 0.0;
          for (d=data,w=weight,p=0; p<npix; w++,p++)
            {
              pix = *(d++);
              pix -=  psfmasks[j][p]*flux[j]**w;
              chi2 += pix*pix;
              if (chi2>1E29) chi2=1E28;
            }
          obj2->chi2_psf = obj2->sigbkg>0.?
            chi2/((npix - 3*npsf)*obj2->sigbkg*obj2->sigbkg):999999;
 
        }
 
    }*/
 /* Compute relative chi2 if asked to */
    if (FLAG(obj2.chi2_psf))
    {
      for (j=0; j<npsf; j++)
        {
          chi2 = 0.0;
          for (d=data,w=weight,p=0; p<npix; w++,p++)
            {
              pix = *(d++)/flux[j];
              pix -=  psfmasks[j][p]**w;
              chi2 += pix*pix;
              if (chi2>1E29) chi2=1E28;
            }
          obj2->chi2_psf = flux[j]>0?
                chi2/((npix - 3*npsf)*obj2->sigbkg*obj2->sigbkg):999999;
 
        }
 
    }
  /* CHECK images */
  if (prefs.check[CHECK_SUBPSFPROTOS] || prefs.check[CHECK_PSFPROTOS])
    for (j=0; j<npsf; j++)
      {
        vignet_resample(psf->maskloc, psf->masksize[0], psf->masksize[1],
                        checkmask, pwidth, pheight,
                        -deltax[j]*pixstep, -deltay[j]*pixstep, pixstep);
        if ((check = prefs.check[CHECK_SUBPSFPROTOS]))
          addcheck(check, checkmask, pwidth,pheight, ix,iy,-flux[j]);
        if ((check = prefs.check[CHECK_PSFPROTOS]))
          addcheck(check, checkmask, pwidth,pheight, ix,iy,flux[j]);
      }
 
  thepsfit->niter = niter;
  thepsfit->npsf = npsf;
  for (j=0; j<npsf; j++)
    {
      thepsfit->x[j] = ix+deltax[j]+1.0;
      thepsfit->y[j] = iy+deltay[j]+1.0;
      thepsfit->flux[j] = flux[j];
      thepsfit->fluxerr[j] = fluxerr[j];
    }
 
  for (i=0; i<prefs.psf_npsfmax; i++)
    {
      QFREE(psfmasks[i]);
      QFREE(psfmaskx[i]);
      QFREE(psfmasky[i]);
    }
 
  QFREE(psfmasks);
  QFREE(psfmaskx);
  QFREE(psfmasky);
  QFREE(datah);
  QFREE(data);
  QFREE(data2);
  QFREE(data3);
  QFREE(weighth);
  QFREE(weight);
  QFREE(data);
  QFREE(mat);
 
  if (prefs.check[CHECK_SUBPSFPROTOS] || prefs.check[CHECK_PSFPROTOS])
    QFREE(checkmask);
 
  return;
}
 
 
/****************************** double_psf_fit ******************************/
/* double fit to make psf detection on one image and photometry on another  */
/****************************************************************************/
 
void    double_psf_fit(psfstruct *ppsf, picstruct *pfield, picstruct *pwfield,
                       obj2struct *obj2,
                        psfstruct *psf, picstruct *field, picstruct *wfield)
{
  static double      /* sum[PSF_NPSFMAX]*/ pdeltax[PSF_NPSFMAX],
    pdeltay[PSF_NPSFMAX],psol[PSF_NPSFMAX], pcovmat[PSF_NPSFMAX*PSF_NPSFMAX],
    pvmat[PSF_NPSFMAX*PSF_NPSFMAX], pwmat[PSF_NPSFMAX],pflux[PSF_NPSFMAX],
    pfluxerr[PSF_NPSFMAX];
 
    double *pmat,
     *pm, /* *pps,  *px, *py,*/
    dx,dy,pdx,pdy, /* x1,y1, mx,my,mflux, */
    val, ppix,ppix2, /* dflux, */
    gain, radmin2,radmax2,satlevel
    ,chi2,pwthresh,pbacknoise2, /* mr, */
    r2=0, psf_fwhm,ppsf_fwhm ;
  float         **ppsfmasks, **ppsfmaskx,**ppsfmasky, *pps;
  float         *pdata, *pdata2, *pdata3, *pweight, *pd, *pw,
                *pdh, *pwh, pixstep,ppixstep;
  PIXTYPE       *pdatah, *pweighth;
  int                   i,j,k,p, npsf, npix,ix,iy,
    width, height, /* hw,hh, */
    x,y, /* yb, */
    wbad, gainflag,
    ival,npsfmax;
  double *pvar;
 
  pdx = pdy =dx = dy = 0.0;
  ppixstep = 1.0/ppsf->pixstep;
  pixstep = 1.0/psf->pixstep;
  gain = (field->gain >0.0? field->gain: 1e30);
  npsfmax=prefs.psf_npsfmax;
  pbacknoise2 = pfield->backsig*pfield->backsig;
  satlevel = field->satur_level - obj2->bkg;
  gainflag = prefs.weightgain_flag;
  psf_fwhm = psf->fwhm*psf->pixstep;
  ppsf_fwhm = ppsf->fwhm*ppsf->pixstep;
  pwthresh = pwfield?pwfield->weight_thresh:BIG;
 
  /* Initialize outputs */
  ppsfit->niter = 0;
  ppsfit->npsf = 0;
  for (j=0; j<npsfmax; j++)
    {
      ppsfit->x[j] = 999999.0;
      ppsfit->y[j] = 999999.0;
      ppsfit->flux[j] = 0.0;
      ppsfit->fluxerr[j] = 0.0;
      pdeltax[j]= pdeltay[j]=psol[j]= pwmat[j]=pflux[j]=pfluxerr[j]=0.0;
 
    }
 
  ix = (obj2->xmax+obj2->xmin+1)/2;
  iy = (obj2->ymax+obj2->ymin+1)/2;
  width = obj2->xmax-obj2->xmin+1+psf_fwhm;
  if (width < (ival=(int)(psf_fwhm*2)))
    width = ival;
  height = obj2->ymax-obj2->ymin+1+psf_fwhm;
  if (height < (ival=(int)(psf_fwhm*2)))
    height = ival;
  npix = width*height;
  radmin2 = PSF_MINSHIFT*PSF_MINSHIFT;
  radmax2 = npix/2.0;
  psf_fit(psf, field, wfield, obj2);
  npsf=thepsfit->npsf;
 
  QMALLOC(ppsfmasks,float *,npsfmax);
  QMALLOC(ppsfmaskx,float *,npsfmax);
  QMALLOC(ppsfmasky,float *,npsfmax);
 
  for (i=0; i<npsfmax; i++)
    {
      QMALLOC(ppsfmasks[i],float,npix);
      QMALLOC(ppsfmaskx[i],float,npix);
      QMALLOC(ppsfmasky[i],float,npix);
    }
 
  QMALLOC(pweighth, PIXTYPE, npix);
  QMALLOC(pweight, float, npix);
  QMALLOC(pdatah, PIXTYPE, npix);
  QMALLOC(pdata, float, npix);
  QMALLOC(pdata2, float, npix);
  QMALLOC(pdata3, float, npix);
  QMALLOC(pmat, double, npix*npsfmax);
 
   for (j=0; j<npsf; j++)
    {
      pdeltax[j] =thepsfit->x[j]-ix-1 ;
      pdeltay[j] =thepsfit->y[j]-iy-1 ;
      ppsfit->flux[j] = 0;
      ppsfit->fluxerr[j] = 0;
    }
 
/*-------------------  Now the photometry fit ---------------------*/
   /* Compute photometry weights */
  wbad = 0;
  if (pwfield)
    {
    psf_copyobjpix(pdatah, pweighth, width, height, ix,iy, obj2, 0);
    for (pwh=pweighth, pw=pweight, pdh=pdatah,p=npix; p--;)
      {
      if ((ppix=*(pwh++)) < pwthresh && ppix>0
                && (ppix2=*(pdh++))>-BIG  && ppix2<satlevel)
        *(pw++) = 1/sqrt(ppix+(ppix2>0.0?
                        (gainflag? ppix2*ppix/pbacknoise2:ppix2)/gain : 0.0));
      else
        {
        *(pw++) = 0.0;
        wbad++;
        }
      }
    }
  else
    {
    psf_copyobjpix(pdatah, NULL, width, height, ix,iy, obj2, 0);
    for (pw=pweight, pdh=pdatah, p=npix; p--;)
      if ((ppix=*(pdh++))>-BIG && ppix<satlevel)
        *(pw++) = 1.0/sqrt(pbacknoise2+(ppix>0.0?ppix/gain:0.0));
      else
        {
        *(pw++) = 0.0;
        wbad++;
        }
    }
 
  /* Special action if most of the weights are zero!! */
  if (wbad>=npix-3)
    return;
 
  /* Weight the data */
  pdh = pdatah;
  pd = pdata;
  pw = pweight;
  val = obj2->dbkg;
  for (p=npix; p--;)
    *(pd++) = (*(pdh++)-val)**(pw++);
 
 
  /* Get the photmetry PSF */
   psf_build(ppsf, obj2);
  for (j=1; j<=npsf; j++)
    {
      if (j>1)
        {
          /*---- Subtract //previously fitted components in photometry image */
          pd = pdata2;
          pdh = pdatah;
          for (p=npix; p--;)
            *(pd++) = (double)*(pdh++);
          for (k=0; k<j-1; k++)
            {
              pd = pdata2;
              pps = ppsfmasks[k];
              for (p=npix; p--;)
                *(pd++) -= pflux[k]**(pps++);
            }
          convolve_image(pfield, pdata2, pdata3, width,height);
         /*---- Ignore regions too close to stellar cores */
          for (k=0; k<j-1; k++)
            {
              pd = pdata3;
              dy = -((double)(height/2)+pdeltay[k]);
              for (y=height; y--; dy += 1.0)
                {
                  dx = -((double)(width/2)+pdeltax[k]);
                  for (x=width; x--; dx+= 1.0, pd++)
                    if (dx*dx+dy*dy<r2) /*?*/
                      *pd = -BIG;
                }
            }
        }
 
      pm=pmat;
      for (k=0; k<j; k++)
            {
              /*------ Resample the PSFs here for the 1st iteration */
              vignet_resample(ppsf->maskloc,
                        ppsf->masksize[0], ppsf->masksize[1],
                        ppsfmasks[k], width, height,
                        -pdeltax[k]*ppixstep, -pdeltay[k]*ppixstep,
                        ppixstep);
              pm=compute_gradient_phot(pweight,width,height, ppsfmasks[k],pm);
            }
 
      svdfit(pmat, pdata, npix, j, psol, pvmat, pwmat);
      compute_pos_phot( &j, psol,pflux);
 
  for (k=0; k<j; k++)
        {
          svdvar(pvmat, pwmat, j, pcovmat);
          pvar = pcovmat;
          pfluxerr[k]= sqrt(*pvar)>0.0 && sqrt(*pvar)<99?
            sqrt(*pvar):99;
        }
    }
  /* Compute chi2 if asked to
  if (FLAG(obj2.chi2_psf))
    {
      for (j=0; j<npsf; j++)
        {
          chi2 = 0.0;
          for (pd=pdata,pw=pweight,p=0; p<npix; pw++,p++)
            {
              ppix = *(pd++);
              ppix -=  ppsfmasks[j][p]*pflux[j]**pw;
              chi2 += ppix*ppix;
              if (chi2>1E29) chi2=1E28;
            }
          obj2->chi2_psf = obj2->sigbkg>0.?
            chi2/((npix - 3*npsf)*obj2->sigbkg*obj2->sigbkg):999999;
 
        }
 
    }
 */
 /* Compute relative error if asked to */
  if (FLAG(obj2.chi2_psf))
  {
      for (j=0; j<npsf; j++)
        {
          chi2 = 0.0;
          for (pd=pdata,pw=pweight,p=0; p<npix; pw++,p++)
            {
              ppix = *(pd++)/pflux[j];
              ppix -=  ppsfmasks[j][p]**pw;
              chi2 += ppix*ppix;
              if (chi2>1E29) chi2=1E28;
            }
          obj2->chi2_psf = pflux[j]>0?
                chi2/((npix - 3*npsf)*obj2->sigbkg*obj2->sigbkg):999999;
 
        }
 
    }
  ppsfit->niter = thepsfit->niter;
  ppsfit->npsf = npsf;
 
  for (j=0; j<npsf; j++)
    {
      thepsfit->x[j] = ix+pdeltax[j]+1.0;
      thepsfit->y[j] = iy+pdeltay[j]+1.0;
      thepsfit->flux[j] = pflux[j];
      thepsfit->fluxerr[j] = pfluxerr[j];
      ppsfit->x[j] = ix+pdeltax[j]+1.0;
      ppsfit->y[j] = iy+pdeltay[j]+1.0;
      ppsfit->flux[j] = pflux[j];
      ppsfit->fluxerr[j] = pfluxerr[j];
    }
 
 
  for (i=0; i<npsfmax; i++)
    {
      QFREE(ppsfmasks[i]);
      QFREE(ppsfmaskx[i]);
      QFREE(ppsfmasky[i]);
    }
 
 
  QFREE(ppsfmasks);
  QFREE(ppsfmaskx);
  QFREE(ppsfmasky);
  QFREE(pdatah);
  QFREE(pdata);
  QFREE(pdata2);
  QFREE(pdata3);
  QFREE(pweighth);
  QFREE(pweight);
  QFREE(pdata);
  QFREE(pmat);
 
  if (prefs.check[CHECK_SUBPSFPROTOS] || prefs.check[CHECK_PSFPROTOS])
    {
      QFREE(checkmask);
    }
  return;
  }
 
 
/****** psf_copyobjpix ******************************************************
PROTO   int psf_copyobjpix(PIXTYPE *data, PIXTYPE *weight,
                        int wout, int hout, int ix, int iy,
                        obj2struct *obj2, int detect_flag);
PURPOSE Copy a piece of the input object image/weights to local arrays.
INPUT   Pointer to the output data array,
        pointer to the output weight array,
        output frame width,
        output frame height,
        integer x coordinate,
        integer y coordinate,
        pointer to the obj2 structure,
        detection field flag (non 0 only for pure detection images).
OUTPUT  RETURN_ERROR if the coordinates are outside object image,
        RETURN_OK otherwise.
NOTES   -.
AUTHOR  E. Bertin (IAP)
VERSION 23/06/2011
 ***/
int     psf_copyobjpix(PIXTYPE *data, PIXTYPE *weight,
                        int wout, int hout, int ix, int iy,
                        obj2struct *obj2, int detect_flag)
  {
   PIXTYPE      *datat,*weightt, *imagein,*weightin;
   int          i,y, win,hin, w2, xmin,xmax,ymin,ymax;
 
/* Set output to -BIG */
  datat = data;
  for (i=wout*hout; i--;)
    *(datat++) = -BIG;
  if (weight)
    memset(weight, 0, wout*hout*sizeof(PIXTYPE));
 
  ix -= obj2->immin[0];
  iy -= obj2->immin[1];
  win = obj2->imsize[0];
  hin = obj2->imsize[1];
 
/* Don't go further if out of frame!! */
  if (ix<0 || ix>=win || iy<0 || iy>=hin)
    return RETURN_ERROR;
 
/* Set the image boundaries */
  w2 = wout;
  ymin = iy-hout/2;
  ymax = ymin + hout;
  if (ymin<0)
    {
    data -= ymin*wout;
    if (weight)
      weight -= ymin*wout;
    ymin = 0;
    }
  if (ymax>hin)
    ymax = hin;
 
  xmin = ix-wout/2;
  xmax = xmin + wout;
  if (xmax>win)
    {
    w2 -= xmax-win;
    xmax = win;
    }
  if (xmin<0)
    {
    data -= xmin;
    if (weight)
      weight -= xmin;
    w2 += xmin;
    xmin = 0;
    }
 
/* Copy the right pixels to the destination */
  imagein = detect_flag? obj2->dimage:obj2->image;
  for (y=ymin; y<ymax; y++, data += wout)
    memcpy(data, imagein + xmin+y*win, w2*sizeof(PIXTYPE));
  if (weight)
    {
    weightin = detect_flag? obj2->dweight:obj2->weight;
    for (y=ymin; y<ymax; y++, data += wout)
      memcpy(weight, weightin + xmin+y*win, w2*sizeof(PIXTYPE));
    }
 
 
  return RETURN_OK;
  }
 
 
 
/******************************* psf_build **********************************/
/*
Build the local PSF (function of "context").
*/
void    psf_build(psfstruct *psf, obj2struct *obj2)
  {
   static double        pos[POLY_MAXDIM];
   double       *basis, fac;
   float        *ppc, *pl;
   int          i,n,p, ndim, npix;
 
  if (psf->build_flag)
    return;
 
  npix = psf->masksize[0]*psf->masksize[1];
 
/* Reset the Local PSF mask */
  memset(psf->maskloc, 0, npix*sizeof(float));
 
/* Grab the context vector */
  ndim = psf->poly->ndim;
  for (i=0; i<ndim; i++)
    {
    ttypeconv((char *)obj2 + ((void *)psf->context[i]-(void *)&flagobj2),
                &pos[i], psf->contexttyp[i],T_DOUBLE);
    pos[i] = (pos[i] - psf->contextoffset[i]) / psf->contextscale[i];
    }
  poly_func(psf->poly, pos);
 
  basis = psf->poly->basis;
 
  ppc = psf->maskcomp;
/* Sum each component */
  for (n = (psf->maskdim>2?psf->masksize[2]:1); n--;)
    {
    pl = psf->maskloc;
    fac = *(basis++);
    for (p=npix; p--;)
      *(pl++) +=  fac**(ppc++);
    }
 
  psf->build_flag = 1;
 
  return;
  }
 
 
/******************************** psf_fwhm **********************************/
/*
Return the local PSF FWHM.
*/
double  psf_fwhm(psfstruct *psf, obj2struct *obj2)
  {
   float        *pl,
                val, max;
   int          n,p, npix;
 
  if (!psf->build_flag)
    psf_build(psf, obj2);
 
  npix = psf->masksize[0]*psf->masksize[1];
  max = -BIG;
  pl = psf->maskloc;
  for (p=npix; p--;)
    if ((val=*(pl++)) > max)
      max = val;
  pl = psf->maskloc;
  max /= 2.0;
  n = 0;
  for (p=npix; p--;)
    if (*(pl++) >= max)
      n++;
 
  return 2.0*sqrt(n/PI)*psf->pixstep;
  }
 
 
/*****************************compute_gradient*********************************/
 
double *compute_gradient(float *weight,int width, int height,
                         float *masks,float *maskx,float *masky
                        ,double *m)
{
  int x,y;
  float *w, *ps,*px,*py;
 
  /*------ copy of the (weighted) PSF, with outer ring set to zero */
      ps = masks;
      w = weight;
      for (y=0; y<height; y++)
        for (x=0; x<width; x++, ps++, w++)
          *(m++) = y?(y>=(height-1)?0:(x?(x>=(width-1)?0:*ps**w):0)):0;
      /*------ (weighted) PSF gradient in x (kernel for first moment in x) */
      ps = masks;
      px = maskx;
      w = weight;
      for (y=0; y<height; y++)
        for (x=0; x<width; x++, ps++, w++)
          *(m++) = ((*px++) = (x?(x>=(width-1)?0:*(ps+1)-*(ps-1)):0))**w/2;
      /*------ (weighted) PSF gradient in y (kernel for first moment in y) */
      ps = masks;
      py = masky;
      w = weight;
      for (y=0; y<height; y++)
        for (x=0; x<width; x++, ps++, w++)
          *(m++) = (*(py++)=(y?(y>=(height-1)?0:*(ps+width)-*(ps-width)):0))
            **w/2;
  return m;
}
 
/*****************************compute_gradient_phot*****************************
****/
 
double *compute_gradient_phot(float  *pweight,int width, int height,
                         float *pmasks,double *pm)
 
{
  int x,y;
  float  *pw, *pps;
 
  /*------ copy of the (weighted) PSF, with outer ring set to zero */
      pps = pmasks;
      pw = pweight;
      for (y=0; y<height; y++)
        for (x=0; x<width; x++, pps++, pw++)
          *(pm++) = y?(y>=(height-1)?0:(x?(x>=(width-1)?0:*pps**pw):0)):0;
 
  return pm;
}
 
/**************************compute_pos********************************/
 
void compute_pos(int *pnpsf,int *pconvflag,int *pnpsfflag,double radmin2,
                         double radmax2,double r2,double *sol,double *flux
                        ,double *deltax,double *deltay,double *pdx,double *pdy)
{
  int j,k,convflag,npsfflag,npsf;
  double dx,dy;
 
  dx=*pdx;
  dy=*pdy;
  convflag=*pconvflag;
  npsfflag=*pnpsfflag;
  npsf=*pnpsf;
  for (j=0; j<npsf; j++)
    {
      flux[j] = sol[j*PSF_NA];
      /*------ Update the PSF shifts */
      if (fabs(flux[j])>0.0)
        {
          dx = -sol[j*PSF_NA+1]/((npsf>1?2:1)*flux[j]);
          dy = -sol[j*PSF_NA+2]/((npsf>1?2:1)*flux[j]);
        }
 
      deltax[j] += dx;
      deltay[j] += dy;
      /*------ Continue until all PSFs have come to a complete stop */
      if ((dx*dx+dy*dy) > radmin2)
        convflag = 1;
    }
  for (j=0; j<npsf; j++)
    {
      /*------ Exit if too much decentering or negative flux */
      for (k=j+1; k<npsf; k++)
        {
          dx = deltax[j]-deltax[k];
          dy = deltay[j]-deltay[k];
          if (dx*dx+dy*dy<r2/4.0)
            {
              flux[j] = -BIG;
              break;
            }
        }
      if (flux[j]<0.0
          || (deltax[j]*deltax[j] + deltay[j]*deltay[j]) > radmax2)
        {
          npsfflag = 0;
          convflag = 0;
          npsf--;
          break;
        }
    }
  *pdx=dx;
  *pdy=dy;
  *pconvflag=convflag;
  *pnpsfflag= npsfflag;
  *pnpsf=npsf;
  return;
}
 
/**************************compute_pos_phot********************************/
 
void compute_pos_phot(int *pnpsf,double *sol,double *flux)
{
  int j,npsf;
  npsf=*pnpsf;
  for (j=0; j<npsf; j++)
    {
      flux[j] = sol[j];
    }
  *pnpsf=npsf;
  return;
}
 
 
/************************************compute_poserr*****************************
*********/
 
void compute_poserr( int j,double *var,double *sol,obj2struct *obj2,double *x2,
                    double *y2,double *xy, int npsf)
{
  double vara,covab,varb, f2;
 
  /*------ Variances and covariance along x and y */
  vara = *(var += (PSF_NA*npsf+1)*(j*PSF_NA+1));
  covab = *(++var);
  varb = *(var += PSF_NA*npsf);
  f2 = sol[PSF_NA*j];
  f2 *= f2;
  obj2->poserrmx2_psf = vara/f2;
  obj2->poserrmy2_psf = varb/f2;
  obj2->poserrmxy_psf = covab/f2;
 
  /*------ If requested, translate variances to major and minor error axes... */
  if (FLAG(obj2.poserra_psf))
    {
      double    pmx2,pmy2,temp,theta;
 
      if (fabs(temp=obj2->poserrmx2_psf-obj2->poserrmy2_psf) > 0.0)
        theta = atan2(2.0 * obj2->poserrmxy_psf,temp) / 2.0;
      else
        theta = PI/4.0;
 
      temp = sqrt(0.25*temp*temp+obj2->poserrmxy_psf*obj2->poserrmxy_psf);
      pmy2 = pmx2 = 0.5*(obj2->poserrmx2_psf+obj2->poserrmy2_psf);
      pmx2+=temp;
      pmy2-=temp;
 
      obj2->poserra_psf = (float)sqrt(pmx2);
      obj2->poserrb_psf = (float)sqrt(pmy2);
      obj2->poserrtheta_psf = theta*180.0/PI;
    }
 
  /*------ ...Or ellipse parameters */
  if (FLAG(obj2.poserr_cxx))
    {
      double    xm2,ym2, xym, temp;
 
      xm2 = obj2->poserrmx2_psf;
      ym2 = obj2->poserrmy2_psf;
      xym = obj2->poserrmxy_psf;
      obj2->poserrcxx_psf = (float)(ym2/(temp=xm2*ym2-xym*xym));
      obj2->poserrcyy_psf = (float)(xm2/temp);
      obj2->poserrcxy_psf = (float)(-2*xym/temp);
    }
  return;
}
 
 
/******************************** svdfit ************************************/
/*
General least-square fit A.x = b, based on Singular Value Decomposition (SVD).
Loosely adapted from Numerical Recipes in C, 2nd Ed. (p. 671).
Note: the a and v matrices are transposed with respect to the N.R. convention.
*/
void svdfit(double *a, float *b, int m, int n, double *sol,
        double *vmat, double *wmat)
  {
#define MAX(a,b) (maxarg1=(a),maxarg2=(b),(maxarg1) > (maxarg2) ?\
        (maxarg1) : (maxarg2))
#define PYTHAG(a,b)     ((at=fabs(a)) > (bt=fabs(b)) ? \
                                  (ct=bt/at,at*sqrt(1.0+ct*ct)) \
                                : (bt ? (ct=at/bt,bt*sqrt(1.0+ct*ct)): 0.0))
#define SIGN(a,b) ((b) >= 0.0 ? fabs(a) : -fabs(a))
#define TOL             1.0e-11
 
   int                  flag,i,its,j,jj,k,l,nm,mmi,nml;
   double               c,f,h,s,x,y,z,
                        anorm, g, scale,
                        at,bt,ct,maxarg1,maxarg2,
                        thresh, wmax,
                        *w,*ap,*ap0,*ap1,*ap10,*rv1p,*vp,*vp0,*vp1,*vp10,
                        *tmpp, *rv1,*tmp;
   float                *bp;
 
  anorm = g = scale = 0.0;
  if (m < n)
    error(EXIT_FAILURE, "*Error*: Not enough rows for solving the system ",
        "in svdfit()");
 
  QMALLOC(rv1, double, n);
  QMALLOC(tmp, double, n);
  l = nm = nml = 0;                      /* To avoid gcc -Wall warnings */
  for (i=0;i<n;i++)
    {
    l = i+1;
    nml = n-l;
    rv1[i] = scale*g;
    g = s = scale = 0.0;
    if ((mmi = m - i) > 0)
      {
      ap = ap0 = a+i*(m+1);
      for (k=mmi;k--;)
        scale += fabs(*(ap++));
      if (scale)
        {
        for (ap=ap0,k=mmi; k--; ap++)
          {
          *ap /= scale;
          s += *ap**ap;
          }
        f = *ap0;
        g = -SIGN(sqrt(s),f);
        h = f*g-s;
        *ap0 = f-g;
        ap10 = a+l*m+i;
        for (j=nml;j--; ap10+=m)
          {
          for (s=0.0,ap=ap0,ap1=ap10,k=mmi; k--;)
            s += *(ap1++)**(ap++);
          f = s/h;
          for (ap=ap0,ap1=ap10,k=mmi; k--;)
            *(ap1++) += f**(ap++);
          }
        for (ap=ap0,k=mmi; k--;)
          *(ap++) *= scale;
        }
      }
    wmat[i] = scale*g;
    g = s = scale = 0.0;
    if (i < m && i+1 != n)
      {
      ap = ap0 = a+i+m*l;
      for (k=nml;k--; ap+=m)
        scale += fabs(*ap);
      if (scale)
        {
        for (ap=ap0,k=nml;k--; ap+=m)
          {
          *ap /= scale;
          s += *ap**ap;
          }
        f=*ap0;
        g = -SIGN(sqrt(s),f);
        h=f*g-s;
        *ap0=f-g;
        rv1p = rv1+l;
        for (ap=ap0,k=nml;k--; ap+=m)
          *(rv1p++) = *ap/h;
        ap10 = a+l+m*l;
        for (j=m-l; j--; ap10++)
          {
          for (s=0.0,ap=ap0,ap1=ap10,k=nml; k--; ap+=m,ap1+=m)
            s += *ap1**ap;
          rv1p = rv1+l;
          for (ap1=ap10,k=nml;k--; ap1+=m)
            *ap1 += s**(rv1p++);
          }
        for (ap=ap0,k=nml;k--; ap+=m)
          *ap *= scale;
        }
      }
    anorm=MAX(anorm,(fabs(wmat[i])+fabs(rv1[i])));
    }
 
  for (i=n-1;i>=0;i--)
    {
    if (i < n-1)
      {
      if (g)
        {
        ap0 = a+l*m+i;
        vp0 = vmat+i*n+l;
        vp10 = vmat+l*n+l;
        g *= *ap0;
        for (ap=ap0,vp=vp0,j=nml; j--; ap+=m)
          *(vp++) = *ap/g;
        for (j=nml; j--; vp10+=n)
          {
          for (s=0.0,ap=ap0,vp1=vp10,k=nml; k--; ap+=m)
            s += *ap**(vp1++);
          for (vp=vp0,vp1=vp10,k=nml; k--;)
            *(vp1++) += s**(vp++);
          }
        }
      vp = vmat+l*n+i;
      vp1 = vmat+i*n+l;
      for (j=nml; j--; vp+=n)
        *vp = *(vp1++) = 0.0;
      }
    vmat[i*n+i]=1.0;
    g=rv1[i];
    l=i;
    nml = n-l;
    }
 
  for (i=(m<n?m:n); --i>=0;)
    {
    l=i+1;
    nml = n-l;
    mmi=m-i;
    g=wmat[i];
    ap0 = a+i*m+i;
    ap10 = ap0 + m;
    for (ap=ap10,j=nml;j--;ap+=m)
      *ap=0.0;
    if (g)
      {
      g=1.0/g;
      for (j=nml;j--; ap10+=m)
        {
        for (s=0.0,ap=ap0,ap1=ap10,k=mmi; --k;)
              s += *(++ap)**(++ap1);
        f = (s/(*ap0))*g;
        for (ap=ap0,ap1=ap10,k=mmi;k--;)
          *(ap1++) += f**(ap++);
        }
      for (ap=ap0,j=mmi;j--;)
        *(ap++) *= g;
      }
    else
      for (ap=ap0,j=mmi;j--;)
        *(ap++)=0.0;
    ++(*ap0);
    }
 
  for (k=n; --k>=0;)
      {
      for (its=0;its<100;its++)
        {
        flag=1;
        for (l=k;l>=0;l--)
          {
          nm=l-1;
          if (fabs(rv1[l])+anorm == anorm)
            {
            flag=0;
            break;
            }
          if (fabs(wmat[nm])+anorm == anorm)
            break;
          }
        if (flag)
          {
          c=0.0;
          s=1.0;
          ap0 = a+nm*m;
          ap10 = a+l*m;
          for (i=l; i<=k; i++,ap10+=m)
            {
            f=s*rv1[i];
            if (fabs(f)+anorm == anorm)
              break;
            g=wmat[i];
            h=PYTHAG(f,g);
            wmat[i]=h;
            h=1.0/h;
            c=g*h;
            s=(-f*h);
            for (ap=ap0,ap1=ap10,j=m; j--;)
              {
              z = *ap1;
              y = *ap;
              *(ap++) = y*c+z*s;
              *(ap1++) = z*c-y*s;
              }
            }
          }
        z=wmat[k];
        if (l == k)
          {
          if (z < 0.0)
            {
            wmat[k] = -z;
            vp = vmat+k*n;
            for (j=n; j--; vp++)
              *vp = (-*vp);
            }
          break;
          }
        if (its == 99)
          error(EXIT_FAILURE, "*Error*: No convergence in 100 SVD iterations ",
                "in svdfit()");
        x=wmat[l];
        nm=k-1;
        y=wmat[nm];
        g=rv1[nm];
        h=rv1[k];
        f=((y-z)*(y+z)+(g-h)*(g+h))/(2.0*h*y);
        g=PYTHAG(f,1.0);
        f=((x-z)*(x+z)+h*((y/(f+SIGN(g,f)))-h))/x;
        c=s=1.0;
        ap10 = a+l*m;
        vp10 = vmat+l*n;
        for (j=l;j<=nm;j++,ap10+=m,vp10+=n)
          {
          i=j+1;
          g=rv1[i];
          y=wmat[i];
          h=s*g;
          g=c*g;
          z=PYTHAG(f,h);
          rv1[j]=z;
          c=f/z;
          s=h/z;
          f=x*c+g*s;
          g=g*c-x*s;
          h=y*s;
          y=y*c;
          for (vp=(vp1=vp10)+n,jj=n; jj--;)
            {
            z = *vp;
            x = *vp1;
            *(vp1++) = x*c+z*s;
            *(vp++) = z*c-x*s;
            }
          z=PYTHAG(f,h);
          wmat[j]=z;
          if (z)
            {
            z=1.0/z;
            c=f*z;
            s=h*z;
            }
          f=c*g+s*y;
          x=c*y-s*g;
          for (ap=(ap1=ap10)+m,jj=m; jj--;)
            {
            z = *ap;
            y = *ap1;
            *(ap1++) = y*c+z*s;
            *(ap++) = z*c-y*s;
            }
          }
        rv1[l]=0.0;
        rv1[k]=f;
        wmat[k]=x;
        }
      }
 
  wmax=0.0;
  w = wmat;
  for (j=n;j--; w++)
    if (*w > wmax)
      wmax=*w;
  thresh=TOL*wmax;
  w = wmat;
  for (j=n;j--; w++)
    if (*w < thresh)
      *w = 0.0;
 
  w = wmat;
  ap = a;
  tmpp = tmp;
  for (j=n; j--; w++)
    {
    s=0.0;
    if (*w)
      {
      bp = b;
      for (i=m; i--;)
        s += *(ap++)**(bp++);
      s /= *w;
      }
    else
      ap += m;
    *(tmpp++) = s;
    }
 
  vp0 = vmat;
  for (j=0; j<n; j++,vp0++)
    {
    s=0.0;
    tmpp = tmp;
    for (vp=vp0,jj=n; jj--; vp+=n)
      s += *vp**(tmpp++);
    sol[j]=s;
    }
 
/* Free temporary arrays */
  free(tmp);
  free(rv1);
 
  return;
  }
 
#undef SIGN
#undef MAX
#undef PYTHAG
#undef TOL
 
/******************************** svdvar ************************************/
/*
Computation of the covariance matrix from the SVD vmat and wmat matrices.A
dapted from Numerical Recipes in C, 2nd Ed. (p. 679).
*/
void svdvar(double *v, double *w, int n, double *cov)
  {
   static double        wti[PSF_NTOT];
   double               sum;
   int                  i,j,k;
 
  for (i=0; i<n; i++)
    wti[i] = w[i]? 1.0/(w[i]*w[i]) : 0.0;
 
  for (i=0; i<n; i++)
    for (j=0; j<=i; j++)
      {
      for (sum=0.0,k=0; k<n; k++)
        sum += v[k*n+i]*v[k*n+j]*wti[k];
      cov[j*n+i] = cov[i*n+j] = sum;
      }
 
  return;
  }
 

Line No.	Rev	Author	Line
1	233	bertin	`/*`
2			`* psf.c`
3	2	bertin	`*`
4	233	bertin	`* Fit a PSF model to an image.`
5	2	bertin	`*`
6	233	bertin	`*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%`
7	2	bertin	`*`
8	233	bertin	`* This file part of: SExtractor`
9	2	bertin	`*`
10	248	bertin	`* Copyright: (C) 1998-2011 Emmanuel Bertin -- IAP/CNRS/UPMC`
11	2	bertin	`*`
12	233	bertin	`* License: GNU General Public License`
13			`*`
14			`* SExtractor is free software: you can redistribute it and/or modify`
15			`* it under the terms of the GNU General Public License as published by`
16			`* the Free Software Foundation, either version 3 of the License, or`
17			`* (at your option) any later version.`
18			`* SExtractor is distributed in the hope that it will be useful,`
19			`* but WITHOUT ANY WARRANTY; without even the implied warranty of`
20			`* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the`
21			`* GNU General Public License for more details.`
22			`* You should have received a copy of the GNU General Public License`
23			`* along with SExtractor. If not, see <http://www.gnu.org/licenses/>.`
24			`*`
25	267	bertin	`* Last modified: 06/10/2011`
26	233	bertin	`*`
27			`%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%/`
28	2	bertin
29			`#ifdef HAVE_CONFIG_H`
30			`#include "config.h"`
31			`#endif`
32
33			`#include <math.h>`
34			`#include <stdio.h>`
35			`#include <stdlib.h>`
36			`#include <string.h>`
37
38			`#include "define.h"`
39			`#include "globals.h"`
40			`#include "prefs.h"`
41			`#include "fits/fitscat.h"`
42			`#include "check.h"`
43	248	bertin	`#include "field.h"`
44	2	bertin	`#include "filter.h"`
45			`#include "image.h"`
46	173	bertin	`#include "wcs/poly.h"`
47	2	bertin	`#include "psf.h"`
48
49			`/------------------------------- variables ---------------------------------/`
50
51
52			`extern keystruct objkey[];`
53			`extern objstruct outobj;`
54
55			`/******************************* psf_init ********************************/`
56			`/*`
57			`Allocate memory and stuff for the PSF-fitting.`
58			`*/`
59			`void psf_init(psfstruct *psf)`
60			`{`
61			`QMALLOC(thepsfit, psfitstruct, 1);`
62	218	bertin	`QMALLOC(thepsfit->x, double, prefs.psf_npsfmax);`
63			`QMALLOC(thepsfit->y, double, prefs.psf_npsfmax);`
64	2	bertin	`QMALLOC(thepsfit->flux, float, prefs.psf_npsfmax);`
65	218	bertin	`QMALLOC(thepsfit->fluxerr, float, prefs.psf_npsfmax);`
66	5	bertin	`QMALLOC(ppsfit, psfitstruct, 1); /?/`
67	218	bertin	`QMALLOC(ppsfit->x, double, prefs.psf_npsfmax);`
68			`QMALLOC(ppsfit->y, double, prefs.psf_npsfmax);`
69	5	bertin	`QMALLOC(ppsfit->flux, float, prefs.psf_npsfmax);`
70	218	bertin	`QMALLOC(ppsfit->fluxerr, float, prefs.psf_npsfmax);`
71	2	bertin
72			`return;`
73			`}`
74
75
76			`/******************************* psf_end *********************************/`
77			`/*`
78			`Free memory occupied by the PSF-fitting stuff.`
79			`*/`
80	5	bertin	`void psf_end(psfstruct psf, psfitstruct psfit)`
81	2	bertin	`{`
82			`int d, ndim;`
83
84			`ndim = psf->poly->ndim;`
85			`for (d=0; d<ndim; d++)`
86			`free(psf->contextname[d]);`
87			`free(psf->context);`
88			`free(psf->contextname);`
89			`free(psf->contextoffset);`
90			`free(psf->contextscale);`
91			`free(psf->contexttyp);`
92			`poly_end(psf->poly);`
93			`free(psf->maskcomp);`
94			`free(psf->maskloc);`
95			`free(psf->masksize);`
96			`free(psf);`
97
98	173	bertin	`if (psfit)`
99			`{`
100			`free(psfit->x);`
101			`free(psfit->y);`
102			`free(psfit->flux);`
103	218	bertin	`free(psfit->fluxerr);`
104	173	bertin	`free(psfit);`
105			`}`
106	2	bertin
107			`return;`
108			`}`
109
110
111			`/******************************* psf_load *******************************/`
112			`/*`
113			`Read the PSF data from a FITS file.`
114			`*/`
115			`psfstruct psf_load(char filename)`
116			`{`
117			`static obj2struct saveobj2;`
118			`psfstruct *psf;`
119			`catstruct *cat;`
120			`tabstruct *tab;`
121			`keystruct *key;`
122			`char head, ci,*co;`
123			`int deg[POLY_MAXDIM], group[POLY_MAXDIM], ndim, ngroup,`
124			`i,k;`
125
126			`/* Open the cat (well it is not a "cat", but simply a FITS file */`
127			`if (!(cat = read_cat(filename)))`
128			`error(EXIT_FAILURE, "Error: PSF file not found: ", filename);`
129
130			`/* OK, we now allocate memory for the PSF structure itself */`
131			`QCALLOC(psf, psfstruct, 1);`
132
133			`/* Store a short copy of the PSF filename */`
134			`if ((ci=strrchr(filename, '/')))`
135			`strcpy(psf->name, ci+1);`
136			`else`
137			`strcpy(psf->name, filename);`
138
139			`if (!(tab = name_to_tab(cat, "PSF_DATA", 0)))`
140			`error(EXIT_FAILURE, "Error: PSF_DATA table not found in catalog ",`
141			`filename);`
142
143			`head = tab->headbuf;`
144
145			`/-- Dimension of the polynomial /`
146			`if (fitsread(head, "POLNAXIS", &ndim, H_INT,T_LONG) == RETURN_OK`
147			`&& ndim)`
148			`{`
149			`/-- So we have a polynomial description of the PSF variations /`
150			`if (ndim > POLY_MAXDIM)`
151			`{`
152			`sprintf(gstr, "Error: The POLNAXIS parameter in %s exceeds %d",`
153			`psf->name, POLY_MAXDIM);`
154			`error(EXIT_FAILURE, gstr, "");`
155			`}`
156
157			`QMALLOC(psf->contextname, char *, ndim);`
158			`QMALLOC(psf->context, double *, ndim);`
159			`QMALLOC(psf->contexttyp, t_type, ndim);`
160			`QMALLOC(psf->contextoffset, double, ndim);`
161			`QMALLOC(psf->contextscale, double, ndim);`
162
163	267	bertin	`/-- We will have to use the flagobj2 struct, so we first save its content /`
164			`saveobj2 = flagobj2;`
165			`/-- flagobj2 is used as a FLAG array, so we initialize it to 0 /`
166			`memset(&flagobj2, 0, sizeof(flagobj2));`
167	2	bertin	`for (i=0; i<ndim; i++)`
168			`{`
169			`/---- Polynomial groups /`
170			`sprintf(gstr, "POLGRP%1d", i+1);`
171			`if (fitsread(head, gstr, &group[i], H_INT,T_LONG) != RETURN_OK)`
172			`goto headerror;`
173
174			`/---- Contexts /`
175			`QMALLOC(psf->contextname[i], char, 80);`
176			`sprintf(gstr, "POLNAME%1d", i+1);`
177			`if (fitsread(head,gstr,psf->contextname[i],H_STRING,T_STRING)!=RETURN_OK)`
178			`goto headerror;`
179			`if (*psf->contextname[i]==(char)':')`
180			`/------ It seems we're facing a FITS header parameter /`
181			`psf->context[i] = NULL; /* This is to tell we'll have to load */`
182			`/* a FITS header context later on */`
183			`else`
184			`/------ The context element is a dynamic object parameter /`
185			`{`
186			`if ((k = findkey(psf->contextname[i], (char *)objkey,`
187			`sizeof(keystruct)))==RETURN_ERROR)`
188			`{`
189			`sprintf(gstr, "Error: %s CONTEXT parameter in %s unknown",`
190			`psf->contextname[i], psf->name);`
191			`error(EXIT_FAILURE, gstr, "");`
192			`}`
193			`key = objkey+k;`
194			`psf->context[i] = key->ptr;`
195			`psf->contexttyp[i] = key->ttype;`
196			`/------ Declare the parameter "active" to trigger computation by SExtractor /`
197			`((char )key->ptr) = (char)'\1';`
198			`}`
199			`/---- Scaling of the context parameter /`
200			`sprintf(gstr, "POLZERO%1d", i+1);`
201			`if (fitsread(head, gstr, &psf->contextoffset[i], H_EXPO, T_DOUBLE)`
202			`!=RETURN_OK)`
203			`goto headerror;`
204			`sprintf(gstr, "POLSCAL%1d", i+1);`
205			`if (fitsread(head, gstr, &psf->contextscale[i], H_EXPO, T_DOUBLE)`
206			`!=RETURN_OK)`
207			`goto headerror;`
208			`}`
209
210			`/-- Number of groups /`
211			`if (fitsread(head, "POLNGRP ", &ngroup, H_INT, T_LONG) != RETURN_OK)`
212			`goto headerror;`
213
214			`for (i=0; i<ngroup; i++)`
215			`{`
216			`/---- Polynomial degree for each group /`
217			`sprintf(gstr, "POLDEG%1d", i+1);`
218			`if (fitsread(head, gstr, &deg[i], H_INT,T_LONG) != RETURN_OK)`
219			`goto headerror;`
220			`}`
221
222			`psf->poly = poly_init(group, ndim, deg, ngroup);`
223
224	267	bertin	`/-- Restore previous flagobj2 content /`
225			`flagobj2 = saveobj2;`
226	2	bertin	`}`
227			`else`
228			`{`
229			`/-- This is a simple, constant PSF /`
230			`psf->poly = poly_init(group, 0, deg, 0);`
231			`psf->context = NULL;`
232			`}`
233
234			`/* Dimensionality of the PSF mask */`
235			`if (fitsread(head, "PSFNAXIS", &psf->maskdim, H_INT, T_LONG) != RETURN_OK)`
236			`goto headerror;`
237			`if (psf->maskdim<2 \|\| psf->maskdim>3)`
238			`error(EXIT_FAILURE, "Error: wrong dimensionality for the PSF "`
239			`"mask in ", filename);`
240			`QMALLOC(psf->masksize, int, psf->maskdim);`
241			`for (i=0; i<psf->maskdim; i++)`
242			`psf->masksize[i] = 1;`
243			`psf->masknpix = 1;`
244			`for (i=0; i<psf->maskdim; i++)`
245			`{`
246			`sprintf(gstr, "PSFAXIS%1d", i+1);`
247			`if (fitsread(head, gstr, &psf->masksize[i], H_INT,T_LONG) != RETURN_OK)`
248			`goto headerror;`
249			`psf->masknpix *= psf->masksize[i];`
250			`}`
251
252			`/* PSF FWHM: defaulted to 3 pixels */`
253			`if (fitsread(head, "PSF_FWHM", &psf->fwhm, H_FLOAT,T_DOUBLE) != RETURN_OK)`
254			`psf->fwhm = 3.0;`
255
256			`/* PSF oversampling: defaulted to 1 */`
257	221	bertin	`if (fitsread(head, "PSF_SAMP", &psf->pixstep,H_FLOAT,T_FLOAT) != RETURN_OK`
258			`\|\| psf->pixstep <= 0.0)`
259	2	bertin	`psf->pixstep = 1.0;`
260
261			`/* Load the PSF mask data */`
262			`key = read_key(tab, "PSF_MASK");`
263			`psf->maskcomp = key->ptr;`
264
265	206	bertin	`QMALLOC(psf->maskloc, float, psf->masksize[0]*psf->masksize[1]);`
266	2	bertin
267			`/* But don't touch my arrays!! */`
268			`blank_keys(tab);`
269
270			`free_cat(&cat, 1);`
271
272			`return psf;`
273
274			`headerror:`
275			`error(EXIT_FAILURE, "Error: Incorrect or obsolete PSF data in ", filename);`
276			`return NULL;`
277			`}`
278
279
280			`/*************************** psf_readcontext *****************************/`
281			`/*`
282			`Read the PSF context parameters in the FITS header.`
283			`*/`
284			`void psf_readcontext(psfstruct psf, picstruct field)`
285			`{`
286			`static double contextval[POLY_MAXDIM];`
287			`int i, ndim;`
288
289			`ndim = psf->poly->ndim;`
290			`for (i=0; i<ndim; i++)`
291			`if (!psf->context[i])`
292			`{`
293			`psf->context[i] = &contextval[i];`
294			`psf->contexttyp[i] = T_DOUBLE;`
295	173	bertin	`if (fitsread(field->tab->headbuf, psf->contextname[i]+1, &contextval[i],`
296	2	bertin	`H_FLOAT,T_DOUBLE) == RETURN_ERROR)`
297			`{`
298			`sprintf(gstr, "Error: %s parameter not found in the header of ",`
299			`psf->contextname[i]+1);`
300			`error(EXIT_FAILURE, gstr, field->rfilename);`
301			`}`
302			`}`
303
304			`return;`
305			`}`
306
307
308			`/****************************** psf_fit *********************************/`
309	234	bertin	`/* standard PSF fit for one component */`
310	5	bertin	`/****************************************************************************/`
311
312	2	bertin	`void psf_fit(psfstruct psf, picstruct field, picstruct *wfield,`
313	267	bertin	`obj2struct *obj2)`
314	5	bertin	`{`
315			`checkstruct *check;`
316	248	bertin	`static double x2[PSF_NPSFMAX],y2[PSF_NPSFMAX],xy[PSF_NPSFMAX],`
317	5	bertin	`deltax[PSF_NPSFMAX],`
318	218	bertin	`deltay[PSF_NPSFMAX],`
319			`flux[PSF_NPSFMAX],fluxerr[PSF_NPSFMAX],`
320	2	bertin	`deltaxb[PSF_NPSFMAX],deltayb[PSF_NPSFMAX],`
321	218	bertin	`fluxb[PSF_NPSFMAX],fluxerrb[PSF_NPSFMAX],`
322	5	bertin	`sol[PSF_NTOT], covmat[PSF_NTOT*PSF_NTOT],`
323	2	bertin	`vmat[PSF_NTOT*PSF_NTOT], wmat[PSF_NTOT];`
324	206	bertin	`float data, data2, data3, weight, d, w;`
325			`double *mat,`
326			`m, var,`
327	5	bertin	`dx,dy,`
328			`pix,pix2, wthresh,val,`
329			`backnoise2, gain, radmin2,radmax2,satlevel,chi2,`
330	2	bertin	`r2, valmax, psf_fwhm;`
331	206	bertin	`float psfmasks, psfmaskx,**psfmasky,`
332	218	bertin	`ps, dh, *wh, pixstep;`
333	217	bertin	`PIXTYPE datah, weighth;`
334	5	bertin	`int i,j,p, npsf,npsfmax, npix, nppix, ix,iy,niter,`
335			`width, height, pwidth,pheight, x,y,`
336	2	bertin	`xmax,ymax, wbad, gainflag, convflag, npsfflag,`
337	18	bertin	`ival,kill=0;`
338	5	bertin
339	2	bertin	`dx = dy = 0.0;`
340			`niter = 0;`
341			`npsfmax = prefs.psf_npsfmax;`
342			`pixstep = 1.0/psf->pixstep;`
343	200	bertin	`gain = (field->gain >0.0? field->gain: 1e30);`
344	2	bertin	`backnoise2 = field->backsig*field->backsig;`
345	267	bertin	`satlevel = field->satur_level - obj2->bkg;`
346	2	bertin	`wthresh = wfield?wfield->weight_thresh:BIG;`
347			`gainflag = prefs.weightgain_flag;`
348			`psf_fwhm = psf->fwhm*psf->pixstep;`
349
350	5	bertin
351			`/* Initialize outputs */`
352	2	bertin	`thepsfit->niter = 0;`
353			`thepsfit->npsf = 0;`
354	5	bertin	`for (j=0; j<npsfmax; j++)`
355	2	bertin	`{`
356	5	bertin	`thepsfit->x[j] = obj2->posx;`
357			`thepsfit->y[j] = obj2->posy;`
358			`thepsfit->flux[j] = 0.0;`
359	218	bertin	`thepsfit->fluxerr[j] = 0.0;`
360	2	bertin	`}`
361
362	5	bertin	`/* Scale data area with object "size" */`
363	267	bertin	`ix = (obj2->xmax+obj2->xmin+1)/2;`
364			`iy = (obj2->ymax+obj2->ymin+1)/2;`
365			`width = obj2->xmax-obj2->xmin+1+psf_fwhm;`
366	2	bertin	`if (width < (ival=(int)(psf_fwhm*2)))`
367			`width = ival;`
368	267	bertin	`height = obj2->ymax-obj2->ymin+1+psf_fwhm;`
369	2	bertin	`if (height < (ival=(int)(psf_fwhm*2)))`
370			`height = ival;`
371			`npix = width*height;`
372			`radmin2 = PSF_MINSHIFT*PSF_MINSHIFT;`
373			`radmax2 = npix/2.0;`
374
375	5	bertin	`/* Scale total area with PSF FWHM */`
376	2	bertin	`pwidth = (int)(psf->masksize[0]*psf->pixstep)+width;;`
377			`pheight = (int)(psf->masksize[1]*psf->pixstep)+height;`
378			`nppix = pwidth*pheight;`
379
380			`QMALLOC(weighth, PIXTYPE, npix);`
381	206	bertin	`QMALLOC(weight, float, npix);`
382	2	bertin	`QMALLOC(datah, PIXTYPE, npix);`
383	206	bertin	`QMALLOC(data, float, npix);`
384			`QMALLOC(data2, float, npix);`
385			`QMALLOC(data3, float, npix);`
386	2	bertin	`QMALLOC(mat, double, npix*PSF_NTOT);`
387	267	bertin	`if (prefs.check[CHECK_SUBPSFPROTOS] \|\| prefs.check[CHECK_PSFPROTOS])`
388	2	bertin	`{`
389	5	bertin	`QMALLOC(checkmask, PIXTYPE, nppix);`
390	2	bertin	`}`
391
392	206	bertin	`QMALLOC(psfmasks, float *, npsfmax);`
393			`QMALLOC(psfmaskx, float *, npsfmax);`
394			`QMALLOC(psfmasky, float *, npsfmax);`
395	2	bertin	`for (i=0; i<npsfmax; i++)`
396			`{`
397	206	bertin	`QMALLOC(psfmasks[i], float, npix);`
398			`QMALLOC(psfmaskx[i], float, npix);`
399			`QMALLOC(psfmasky[i], float, npix);`
400	2	bertin	`}`
401
402	5	bertin	`/* Compute weights */`
403	2	bertin	`wbad = 0;`
404			`if (wfield)`
405			`{`
406	249	bertin	`psf_copyobjpix(datah, weighth, width, height, ix,iy, obj2,`
407	248	bertin	`!(field->flags&MEASURE_FIELD));`
408			`for (wh=weighth, w=weight, dh=datah,p=npix; p--;)`
409			`if ((pix=*(wh++)) < wthresh && pix>0`
410			`&& (pix2=*(dh++))>-BIG`
411			`&& pix2<satlevel)`
412			`*(w++) = 1/sqrt(pix+(pix2>0.0?`
413			`(gainflag? pix2*pix/backnoise2:pix2)/gain`
414			`:0.0));`
415	5	bertin	`else`
416			`{`
417	248	bertin	`*(w++) = 0.0;`
418			`wbad++;`
419	5	bertin	`}`
420	2	bertin	`}`
421			`else`
422	248	bertin	`{`
423	249	bertin	`psf_copyobjpix(datah, NULL, width, height, ix,iy, obj2,`
424	248	bertin	`!(field->flags&MEASURE_FIELD));`
425	2	bertin	`for (w=weight, dh=datah, p=npix; p--;)`
426			`if ((pix=*(dh++))>-BIG && pix<satlevel)`
427			`*(w++) = 1.0/sqrt(backnoise2+(pix>0.0?pix/gain:0.0));`
428			`else`
429			`{`
430	5	bertin	`*(w++) = 0.0;`
431			`wbad++;`
432	2	bertin	`}`
433	248	bertin	`}`
434	2	bertin
435	5	bertin	`/* Special action if most of the weights are zero!! */`
436	2	bertin	`if (wbad>=npix-3)`
437			`return;`
438
439	5	bertin	`/* Weight the data */`
440	2	bertin	`dh = datah;`
441	267	bertin	`val = obj2->dbkg; /* Take into account a local background change */`
442	2	bertin	`d = data;`
443			`w = weight;`
444			`for (p=npix; p--;)`
445			`(d++) = ((dh++)-val)**(w++);`
446
447	5	bertin	`/* Get the local PSF */`
448	267	bertin	`psf_build(psf, obj2);`
449	2	bertin
450			`npsfflag = 1;`
451			`r2 = psf_fwhm*psf_fwhm/2.0;`
452	218	bertin	`fluxb[0] = fluxerrb[0] = deltaxb[0] = deltayb[0] = 0.0;`
453	5	bertin
454	2	bertin	`for (npsf=1; npsf<=npsfmax && npsfflag; npsf++)`
455			`{`
456	5	bertin	`kill=0;`
457	2	bertin	`/-- First compute an optimum initial guess for the positions of components /`
458	5	bertin	`if (npsf>1)`
459			`{`
460	2	bertin	`/---- Subtract previously fitted components /`
461	5	bertin	`d = data2;`
462			`dh = datah;`
463			`for (p=npix; p--;)`
464			`(d++) = (double)(dh++);`
465			`for (j=0; j<npsf-1; j++)`
466			`{`
467			`d = data2;`
468			`ps = psfmasks[j];`
469			`for (p=npix; p--;)`
470			`(d++) -= flux[j]*(ps++);`
471			`}`
472			`convolve_image(field, data2, data3, width,height);`
473	2	bertin	`/---- Ignore regions too close to stellar cores /`
474	5	bertin	`for (j=0; j<npsf-1; j++)`
475	2	bertin	`{`
476	5	bertin	`d = data3;`
477			`dy = -((double)(height/2)+deltay[j]);`
478			`for (y=height; y--; dy += 1.0)`
479			`{`
480			`dx = -((double)(width/2)+deltax[j]);`
481			`for (x=width; x--; dx+= 1.0, d++)`
482			`if (dxdx+dydy<r2)`
483			`*d = -BIG;`
484			`}`
485	2	bertin	`}`
486	5	bertin	`/---- Now find the brightest pixel (poor man's guess, to be refined later) /`
487			`d = data3;`
488			`valmax = -BIG;`
489			`xmax = width/2;`
490			`ymax = height/2;`
491			`for (y=0; y<height; y++)`
492			`for (x=0; x<width; x++)`
493			`{`
494			`if ((val = *(d++))>valmax)`
495			`{`
496			`valmax = val;`
497			`xmax = x;`
498			`ymax = y;`
499			`}`
500			`}`