fpga/x359/test_scripts/sensors_init.php

Go to the documentation of this file.

<?php
/*!***************************************************************************
*! FILE NAME  : sensors_init.php
*! DESCRIPTION: reads parameters from the sensor 1 and writes to other sensors
*! Copyright (C) 2008 Elphel, Inc
*! -----------------------------------------------------------------------------**
*!
*!  This program 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.
*!
*!  This program 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 this program.  If not, see <http://www.gnu.org/licenses/>.
*! -----------------------------------------------------------------------------**
*!  $Log: sensors_init.php,v $
*!  Revision 1.1.1.1  2008/11/27 20:04:02  elphel
*!
*!
*!  Revision 1.2  2008/05/01 20:32:29  dzhimiev
*!  reads each sensor registers after configuration
*!
*!  Revision 1.1  2008/04/23 01:55:49  dzhimiev
*!  1. added x359 files to src lists
*!  2. x359 read/write DDR
*!  3. x359 3 channels mux directly to out
*!  4. x359 one channel through DDR and another directly frames switching at out
*!
*/

function send_i2c($width,$bus,$a,$d,$raw=0) { //$a<0 - use raw read/write
   $w=($width==16)?2:1;
   $i2c_fn='/dev/xi2c'.($raw?'raw':(($w==2)?'16':'8')).(($bus==0)?'':'_aux');
   $i2c  = fopen($i2c_fn, 'w');
   fseek ($i2c, $w*$a) ;
   if ($w==1)    $res=fwrite($i2c, chr ($d));
   else          $res=fwrite($i2c, chr (floor($d/256)).chr ($d-256*floor($d/256)));
   fclose($i2c);
   return $res;
} // end of send_i2c()

function send_i2c_4($width,$bus,$a,$d,$raw=0) { //$a<0 - use raw read/write
   $w=2;
   $i2c_fn='/dev/xi2c'.($raw?'raw':(($w==2)?'16':'8')).(($bus==0)?'':'_aux');
   $i2c  = fopen($i2c_fn, 'w');
   fseek ($i2c, $w*$a) ;
   if ($w==1)    $res=fwrite($i2c, chr ($d));
   else          $res=fwrite($i2c, chr (floor($d/(256*256*256))).chr (($d - 256*256*256*floor($d/(256*256*256)))/(256*256)).chr (($d - 256*256*floor($d/(256*256)))/256).chr ($d - 256*floor($d/(256))) );

         //printf("Sending passage ");
         //printf("%02x%02x%02x%02x ",(floor($d/(256*256*256))),(($d - 256*256*256*floor($d/(256*256*256)))/(256*256)),(($d - 256*256*floor($d/(256*256)))/256),($d - 256*floor($d/(256))));     
         //printf("\n");

   fclose($i2c);
   return $res;
} // end of send_i2c()

function receive_i2c($width,$bus,$a,$raw=0) {
   $w=($width==16)?2:1;
   $i2c_fn='/dev/xi2c'.($raw?'raw':(($w==2)?'16':'8')).(($bus==0)?'':'_aux');
   $i2c  = fopen($i2c_fn, 'r');
   fseek ($i2c, $w*$a);
   $data = fread($i2c, $w);
   fclose($i2c);
   if (strlen($data)<$w) return -1;
   $v=unpack(($w==1)?'C':'n1',$data);
   return $v[1];
} // end of receive_i2c()

function receive_i2c_4($width,$bus,$a,$raw=0) {
   $w=($width==16)?2:1;
   $i2c_fn='/dev/xi2c'.($raw?'raw':(($w==2)?'16':'8')).(($bus==0)?'':'_aux');
   $i2c  = fopen($i2c_fn, 'r');
         fseek ($i2c, 4, SEEK_END);
   fseek ($i2c, $w*$a);
         
   $data = fread($i2c, 2*$w);
   fclose($i2c);
   if (strlen($data)<2*$w) return -1;
   $v=unpack(($w==1)?'C*':'N*',$data);
         //print_r($v);
         //printf("0x%x\n",$v[1]);
         return $v[1];
} // end of receive_i2c()

function dcm_reset($width,$bus,$raw=0){

        printf("sent 0x%04x ",0x0810); send_i2c_4($width,$bus,0x0810,0xffffffff,$raw=0);
        printf("\nsent 0x%04x ",0x0810); send_i2c_4($width,$bus,0x0810,0x00000000,$raw=0);
        
}

function sensor_init($width,$bus,$channel,$init_pars,$raw=0){


        for ($i=0;$i<256;$i++){
                send_i2c($width,$bus,0x4800+$i,$init_pars[$i],$raw=0);

                //printf("%04x ",$init_pars[$i]);       

                $readout=receive_i2c($width,$bus,0x4800+$i,$raw=0);
                printf("%04x ",$readout);

                if($j==15){
                        $j=0; printf("\n");
                }else{
                        $j++;
                }
        }
}

$width=16;
$bus=0;
$sphase=0x0000007;

printf("<pre>\n");

dcm_reset($width,$bus,$raw=0);

send_i2c_4($width,$bus,0x0835,0x00000001,$raw=0); printf("\nSet to sensor <font size=\"6\">1</font>\n");

// read sens 1 pars
for ($i=0;$i<256;$i++){
        $init_pars[$i]=receive_i2c($width,$bus,0x4800+$i,$raw=0);

        printf("%04x ",$init_pars[$i]); 

        if($j==15){
                $j=0; printf("\n");
        }else{
                $j++;
        }
        
}

// write sens1 pars to sens2
send_i2c_4($width,$bus,0x0835,0x00000002,$raw=0); printf("\nInitializing sensor <font size=\"6\">2</font>\n");
sensor_init(16,0,0x00000004,$init_pars,$raw=0);
// write sens1 pars to sens3
send_i2c_4($width,$bus,0x0835,0x00000004,$raw=0); printf("\nInitializing sensor <font size=\"6\">3</font>\n");
sensor_init(16,0,0x00000002,$init_pars,$raw=0);

send_i2c_4($width,$bus,0x0835,0x00000001,$raw=0); printf("\nSet back to sensor <font size=\"6\">1</font>\n");

//phase adjustment
for ($i=0;$i<20;$i++){
        send_i2c_4($width,$bus,0x0807,0x00000001,$raw=0);
}

printf("</pre>\n");

?> 

---