Diff: MARY_CAMERA.cpp

Revision:

0:f4584dba3bac

Child:

1:1e51936de820

Child:

2:ee71ffdf317e

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MARY_CAMERA.cpp	Fri Feb 14 14:19:49 2014 +0000
@@ -0,0 +1,147 @@
+#include    "mbed.h"
+#include    "MARY_CAMERA.h"
+
+const char param[2][PARAM_NUM] = {
+    {
+        0x01,0x02,0x03,0x0c,0x0e,0x0f,0x11,0x12,0x15,0x16,0x17,0x18,0x19,0x1a,0x1e,0x21,0x22,
+        0x29,0x32,0x33,0x34,0x35,0x37,0x38,0x39,0x3b,0x3c,0x3d,0x3e,0x3f,0x40,0x41,0x41,
+        0x43,0x44,0x45,0x46,0x47,0x48,0x4b,0x4c,0x4d,0x4e,0x4f,0x50,0x51,0x52,0x53,
+        0x54,0x56,0x58,0x59,0x5a,0x5b,0x5c,0x5d,0x5e,0x69,0x6a,0x6b,0x6c,0x6d,0x6e,
+        0x6f,0x70,0x71,0x72,0x73,0x74,0x75,0x76,0x77,0x78,0x79,0x8d,0x8e,0x8f,0x90,
+        0x91,0x96,0x96,0x97,0x98,0x99,0x9a,0x9a,0x9b,0x9c,0x9d,0x9e,0xa2,0xa4,0xb0,
+        0xb1,0xb2,0xb3,0xb8,0xc8,0xc9
+    },
+    {
+        0x40,0x60,0x02,0x0c,0x61,0x4b,0x81,0x04 ,0x00,0x02,0x39,0x03,0x03,0x7b,0x37,0x02,0x91,
+        0x07,0x80,0x0b,0x11,0x0b,0x1d,0x71,0x2a,0x12,0x78,0xc3,0x11,0x00,0xd0,0x08,0x38,
+        0x0a,0xf0,0x34,0x58,0x28,0x3a,0x09,0x00,0x40,0x20,0x80,0x80,0x00,0x22,0x5e,
+        0x80,0x40,0x9e,0x88,0x88,0x44,0x67,0x49,0x0e,0x00,0x40,0x0a,0x0a,0x55,0x11,
+        0x9f,0x3a,0x35,0x11,0xf1,0x10,0x05,0xe1,0x01,0x04,0x01,0x4f,0x00,0x00,0x00,
+        0x00,0x00,0x00,0x30,0x20,0x30,0x00,0x84,0x29,0x03,0x4c,0x3f,0x52,0x88,0x84,
+        0x0c,0x0e,0x82,0x0a,0xf0,0x60
+    }
+};
+
+#define     RESET_PULSE_WIDTH   100     //  mili-seconds
+#define     RESET_RECOVERY_TIME 100     //  mili-seconds
+
+
+#define     PIXEL_PER_LINE  176
+#define     BYTE_PER_PIXEL  2
+#define     BYTE_PER_LINE   (PIXEL_PER_LINE * BYTE_PER_PIXEL)
+
+
+
+MARY_CAMERA::MARY_CAMERA(
+    PinName spi_mosi,
+    PinName spi_miso,
+    PinName spi_sck,
+    PinName spi_cs,
+    PinName cam_vsync,
+    PinName cam_reset,
+    PinName i2c_sda,
+    PinName i2c_scl
+) : 
+spi( spi_mosi, spi_miso, spi_sck ),
+    cs( spi_cs ),
+    vsync( cam_vsync ),
+    reset( cam_reset ),
+    i2c( i2c_sda, i2c_scl )
+{
+    init();
+}
+
+
+
+/** initialiation
+ *
+ *  Performs reset and initialization
+ */
+void MARY_CAMERA::init( void )
+{
+    vsync   = 0;
+    cs      = 1;
+
+    reset = 0;
+    wait_ms( RESET_PULSE_WIDTH );
+
+    reset = 1;
+    wait_ms( RESET_RECOVERY_TIME );
+
+
+    for ( int i = 0; i < PARAM_NUM; i++ ) {
+        i2c.start();
+        i2c.write( CAM_I2C_ADDR );
+        i2c.write( param[ 0 ][ i ] );
+        i2c.write( param[ 1 ][ i ] );
+        i2c.stop();
+        wait_ms( 20 );
+    }
+
+    spi.format(8);
+    spi.frequency( SPI_FREQUENCY );
+    vsync   = 0;
+}
+
+void MARY_CAMERA::transfer_a_line( short *p, int line_number, int x_offset, int n_of_pixels )
+{
+    set_address( line_number * BYTE_PER_LINE + x_offset * BYTE_PER_PIXEL );
+
+    read_register( CAMERA_DATA_REGISTER );
+
+    for( int x = 0; x < n_of_pixels; x++ )
+        *p++    = (read_register( CAMERA_DATA_REGISTER ) << 8) | (read_register( CAMERA_DATA_REGISTER ) << 0);
+}
+
+void MARY_CAMERA::write_register( char reg, char value )
+{
+    send_spi( COMMAND_WRITE | reg );
+    send_spi( value );
+}
+
+int MARY_CAMERA::read_register( char reg )
+{
+    return ( send_spi( COMMAND_READ | reg | ((reg == CAMERA_DATA_REGISTER) ? COMMAND_ADDR_INCREMENT : 0x00) ) );
+}
+
+void MARY_CAMERA::open_transfer( void )
+{
+    write_register( CONTROL_DATA_REGISTER, CONTROL__PAUSE_BUFFER_UPDATE );
+
+    vsync   = 0;
+
+    read_register( STATUS_REGISTER );
+    while ( !(read_register( STATUS_REGISTER ) & 0x1) ); //  wait until LSB becomes '1'
+}
+
+void MARY_CAMERA::close_transfer( void )
+{
+    write_register( CONTROL_DATA_REGISTER, CONTROL__RESUME_BUFFER_UPDATE );
+
+    read_register( STATUS_REGISTER );
+    while ( read_register( STATUS_REGISTER ) & 0x1 ); //  wait until LSB becomes '0'
+
+    vsync   = 1;
+}
+
+
+void MARY_CAMERA::set_address( int address )
+{
+    write_register( MEMORY_ADDR_LOW__REGISTER, (address >>  0) & 0xFF );
+    write_register( MEMORY_ADDR_MID__REGISTER, (address >>  8) & 0xFF );
+    write_register( MEMORY_ADDR_HIGH_REGISTER, (address >> 16) & 0xFF );
+}
+
+int MARY_CAMERA::send_spi( char data )
+{
+    int     tmp;
+
+    cs  = 0;
+    tmp = spi.write( data );
+    cs  = 1;
+
+    return ( tmp );
+}
+
+
+