INSAT Mini Project
Dependencies: ST_INTERFACES X_NUCLEO_COMMON
Fork of X_NUCLEO_6180XA1 by
x_nucleo_6180xa1.cpp@41:2e00362bdb8e, 2016-03-03 (annotated)
- Committer:
- mapellil
- Date:
- Thu Mar 03 10:43:01 2016 +0000
- Revision:
- 41:2e00362bdb8e
- Parent:
- 36:f6278b3e7c82
- Child:
- 46:116dadbc80f1
Check if 6180 InterruptIn pin is NC do not register call back function.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
gallonm | 10:4954b09b72d8 | 1 | /** |
gallonm | 10:4954b09b72d8 | 2 | ****************************************************************************** |
gallonm | 10:4954b09b72d8 | 3 | * @file x_nucleo_6180xa1.cpp |
gallonm | 10:4954b09b72d8 | 4 | * @author AST / EST |
gallonm | 10:4954b09b72d8 | 5 | * @version V0.0.1 |
gallonm | 10:4954b09b72d8 | 6 | * @date 13-April-2015 |
gallonm | 10:4954b09b72d8 | 7 | * @brief Implementation file for the X_NUCLEO_VL6180XA1 singleton class |
gallonm | 10:4954b09b72d8 | 8 | ****************************************************************************** |
gallonm | 10:4954b09b72d8 | 9 | * @attention |
gallonm | 10:4954b09b72d8 | 10 | * |
gallonm | 10:4954b09b72d8 | 11 | * <h2><center>© COPYRIGHT(c) 2015 STMicroelectronics</center></h2> |
gallonm | 10:4954b09b72d8 | 12 | * |
gallonm | 10:4954b09b72d8 | 13 | * Redistribution and use in source and binary forms, with or without modification, |
gallonm | 10:4954b09b72d8 | 14 | * are permitted provided that the following conditions are met: |
gallonm | 10:4954b09b72d8 | 15 | * 1. Redistributions of source code must retain the above copyright notice, |
gallonm | 10:4954b09b72d8 | 16 | * this list of conditions and the following disclaimer. |
gallonm | 10:4954b09b72d8 | 17 | * 2. Redistributions in binary form must reproduce the above copyright notice, |
gallonm | 10:4954b09b72d8 | 18 | * this list of conditions and the following disclaimer in the documentation |
gallonm | 10:4954b09b72d8 | 19 | * and/or other materials provided with the distribution. |
gallonm | 10:4954b09b72d8 | 20 | * 3. Neither the name of STMicroelectronics nor the names of its contributors |
gallonm | 10:4954b09b72d8 | 21 | * may be used to endorse or promote products derived from this software |
gallonm | 10:4954b09b72d8 | 22 | * without specific prior written permission. |
gallonm | 10:4954b09b72d8 | 23 | * |
gallonm | 10:4954b09b72d8 | 24 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
gallonm | 10:4954b09b72d8 | 25 | * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
gallonm | 10:4954b09b72d8 | 26 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
gallonm | 10:4954b09b72d8 | 27 | * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE |
gallonm | 10:4954b09b72d8 | 28 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
gallonm | 10:4954b09b72d8 | 29 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR |
gallonm | 10:4954b09b72d8 | 30 | * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
gallonm | 10:4954b09b72d8 | 31 | * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
gallonm | 10:4954b09b72d8 | 32 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
gallonm | 10:4954b09b72d8 | 33 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
gallonm | 10:4954b09b72d8 | 34 | * |
gallonm | 10:4954b09b72d8 | 35 | ****************************************************************************** |
gallonm | 10:4954b09b72d8 | 36 | */ |
gallonm | 10:4954b09b72d8 | 37 | |
gallonm | 10:4954b09b72d8 | 38 | |
gallonm | 10:4954b09b72d8 | 39 | /* Includes ------------------------------------------------------------------*/ |
gallonm | 10:4954b09b72d8 | 40 | #include "x_nucleo_6180xa1.h" |
gallonm | 10:4954b09b72d8 | 41 | |
gallonm | 10:4954b09b72d8 | 42 | /* Static variables ----------------------------------------------------------*/ |
gallonm | 10:4954b09b72d8 | 43 | X_NUCLEO_6180XA1* X_NUCLEO_6180XA1::_instance = NULL; |
gallonm | 10:4954b09b72d8 | 44 | |
gallonm | 10:4954b09b72d8 | 45 | X_NUCLEO_6180XA1* X_NUCLEO_6180XA1::Instance(DevI2C *ext_i2c) |
gallonm | 10:4954b09b72d8 | 46 | { |
gallonm | 16:0d4776564733 | 47 | if(_instance==NULL) |
gallonm | 16:0d4776564733 | 48 | _instance=new X_NUCLEO_6180XA1(ext_i2c); |
gallonm | 16:0d4776564733 | 49 | else |
gallonm | 28:7c9031e96c22 | 50 | VL6180x_ErrLog("Failed to create X_NUCLEO_6180XA1 instance\n\r"); |
gallonm | 16:0d4776564733 | 51 | return _instance; |
gallonm | 10:4954b09b72d8 | 52 | } |
gallonm | 10:4954b09b72d8 | 53 | |
mapellil | 36:f6278b3e7c82 | 54 | X_NUCLEO_6180XA1* X_NUCLEO_6180XA1::Instance(DevI2C *ext_i2c, |
mapellil | 36:f6278b3e7c82 | 55 | PinName gpio1_top, PinName gpio1_bottom, |
mapellil | 36:f6278b3e7c82 | 56 | PinName gpio1_left, PinName gpio1_right) |
mapellil | 36:f6278b3e7c82 | 57 | { |
mapellil | 36:f6278b3e7c82 | 58 | if(_instance==NULL) |
mapellil | 36:f6278b3e7c82 | 59 | //_instance=new X_NUCLEO_6180XA1(ext_i2c); |
mapellil | 36:f6278b3e7c82 | 60 | _instance=new X_NUCLEO_6180XA1(ext_i2c, gpio1_top, gpio1_bottom, gpio1_left, gpio1_right); |
mapellil | 36:f6278b3e7c82 | 61 | else |
mapellil | 36:f6278b3e7c82 | 62 | VL6180x_ErrLog("Failed to create X_NUCLEO_6180XA1 instance\n\r"); |
mapellil | 36:f6278b3e7c82 | 63 | return _instance; |
mapellil | 36:f6278b3e7c82 | 64 | } |
mapellil | 36:f6278b3e7c82 | 65 | |
gallonm | 10:4954b09b72d8 | 66 | |
gallonm | 20:dd8390d615bf | 67 | int X_NUCLEO_6180XA1::InitBoard() |
gallonm | 10:4954b09b72d8 | 68 | { |
gallonm | 16:0d4776564733 | 69 | int status, n_dev=0; |
gallonm | 15:454710d17358 | 70 | |
gallonm | 16:0d4776564733 | 71 | sensor_top->VL6180x_Off(); |
gallonm | 16:0d4776564733 | 72 | sensor_bottom->VL6180x_Off(); |
gallonm | 16:0d4776564733 | 73 | sensor_left->VL6180x_Off(); |
gallonm | 16:0d4776564733 | 74 | sensor_right->VL6180x_Off(); |
gallonm | 16:0d4776564733 | 75 | status=sensor_top->InitSensor(NEW_SENSOR_TOP_ADDRESS); |
gallonm | 16:0d4776564733 | 76 | if(status) |
gallonm | 16:0d4776564733 | 77 | { |
gallonm | 16:0d4776564733 | 78 | delete sensor_top; |
gallonm | 16:0d4776564733 | 79 | delete gpio0_top; |
gallonm | 16:0d4776564733 | 80 | sensor_top=NULL; |
gallonm | 16:0d4776564733 | 81 | gpio0_top=NULL; |
gallonm | 27:22c6f69967d9 | 82 | printf("Sensor top not present\n\r"); |
gallonm | 16:0d4776564733 | 83 | } |
gallonm | 16:0d4776564733 | 84 | else |
gallonm | 16:0d4776564733 | 85 | { |
gallonm | 27:22c6f69967d9 | 86 | printf("Sensor top present\n\r"); |
gallonm | 16:0d4776564733 | 87 | n_dev++; |
gallonm | 16:0d4776564733 | 88 | } |
gallonm | 16:0d4776564733 | 89 | status=sensor_bottom->InitSensor(NEW_SENSOR_BOTTOM_ADDRESS); |
gallonm | 16:0d4776564733 | 90 | if(status) |
gallonm | 16:0d4776564733 | 91 | { |
gallonm | 16:0d4776564733 | 92 | delete sensor_bottom; |
gallonm | 16:0d4776564733 | 93 | delete gpio0_bottom; |
gallonm | 16:0d4776564733 | 94 | sensor_bottom=NULL; |
gallonm | 16:0d4776564733 | 95 | gpio0_bottom=NULL; |
gallonm | 27:22c6f69967d9 | 96 | printf("Sensor bottom not present\n\r"); |
gallonm | 16:0d4776564733 | 97 | } |
gallonm | 16:0d4776564733 | 98 | else |
gallonm | 16:0d4776564733 | 99 | { |
gallonm | 27:22c6f69967d9 | 100 | printf("Sensor bottom present\n\r"); |
gallonm | 16:0d4776564733 | 101 | n_dev++; |
gallonm | 16:0d4776564733 | 102 | } |
gallonm | 16:0d4776564733 | 103 | status=sensor_left->InitSensor(NEW_SENSOR_LEFT_ADDRESS); |
gallonm | 16:0d4776564733 | 104 | if(status) |
gallonm | 16:0d4776564733 | 105 | { |
gallonm | 16:0d4776564733 | 106 | delete sensor_left; |
gallonm | 16:0d4776564733 | 107 | delete gpio0_left; |
gallonm | 16:0d4776564733 | 108 | sensor_left=NULL; |
gallonm | 16:0d4776564733 | 109 | gpio0_left=NULL; |
gallonm | 27:22c6f69967d9 | 110 | printf("Sensor left not present\n\r"); |
gallonm | 16:0d4776564733 | 111 | } |
gallonm | 16:0d4776564733 | 112 | else |
gallonm | 16:0d4776564733 | 113 | { |
gallonm | 27:22c6f69967d9 | 114 | printf("Sensor left present\n\r"); |
gallonm | 16:0d4776564733 | 115 | n_dev++; |
gallonm | 16:0d4776564733 | 116 | } |
gallonm | 16:0d4776564733 | 117 | status=sensor_right->InitSensor(NEW_SENSOR_RIGHT_ADDRESS); |
gallonm | 16:0d4776564733 | 118 | if(status) |
gallonm | 16:0d4776564733 | 119 | { |
gallonm | 16:0d4776564733 | 120 | delete sensor_right; |
gallonm | 16:0d4776564733 | 121 | delete gpio0_right; |
gallonm | 16:0d4776564733 | 122 | sensor_right=NULL; |
gallonm | 20:dd8390d615bf | 123 | gpio0_right=NULL; |
gallonm | 27:22c6f69967d9 | 124 | printf("Sensor right not present\n\r"); |
gallonm | 16:0d4776564733 | 125 | } |
gallonm | 16:0d4776564733 | 126 | else |
gallonm | 16:0d4776564733 | 127 | { |
gallonm | 27:22c6f69967d9 | 128 | printf("Sensor right present\n\r"); |
gallonm | 16:0d4776564733 | 129 | n_dev++; |
gallonm | 16:0d4776564733 | 130 | } |
gallonm | 16:0d4776564733 | 131 | if(n_dev==0) |
gallonm | 16:0d4776564733 | 132 | return 1; |
gallonm | 16:0d4776564733 | 133 | else |
gallonm | 16:0d4776564733 | 134 | return 0; |
gallonm | 10:4954b09b72d8 | 135 | } |
gallonm | 10:4954b09b72d8 | 136 | |
gallonm | 10:4954b09b72d8 | 137 |