Modified for compatibility with Rev.E. hardware
Fork of AkmSensor by
akmhallswitch.cpp@29:b488d2c89fba, 2017-03-17 (annotated)
- Committer:
- masahikofukasawa
- Date:
- Fri Mar 17 23:29:20 2017 +0000
- Revision:
- 29:b488d2c89fba
- Parent:
- 27:41aa9fb23a2f
- Child:
- 43:45225713cd58
Modified for multi sensor demo.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
masahikofukasawa | 0:7a00359e701e | 1 | #include "akmhallswitch.h" |
masahikofukasawa | 0:7a00359e701e | 2 | #include "debug.h" |
masahikofukasawa | 0:7a00359e701e | 3 | |
masahikofukasawa | 0:7a00359e701e | 4 | /////////////////////////////////////////////////////////////////////////////////// |
masahikofukasawa | 0:7a00359e701e | 5 | // Interface implementation |
masahikofukasawa | 0:7a00359e701e | 6 | /////////////////////////////////////////////////////////////////////////////////// |
masahikofukasawa | 0:7a00359e701e | 7 | /** |
masahikofukasawa | 0:7a00359e701e | 8 | * Constructor. |
masahikofukasawa | 0:7a00359e701e | 9 | * |
masahikofukasawa | 0:7a00359e701e | 10 | */ |
masahikofukasawa | 27:41aa9fb23a2f | 11 | AkmHallSwitch::AkmHallSwitch() : AkmSensor(){ |
masahikofukasawa | 0:7a00359e701e | 12 | sw0 = NULL; |
masahikofukasawa | 0:7a00359e701e | 13 | sw1 = NULL; |
masahikofukasawa | 0:7a00359e701e | 14 | d0 = DigitalIn(DIGITAL_D0); |
masahikofukasawa | 0:7a00359e701e | 15 | d1 = DigitalIn(DIGITAL_D1); |
masahikofukasawa | 0:7a00359e701e | 16 | } |
masahikofukasawa | 0:7a00359e701e | 17 | |
masahikofukasawa | 0:7a00359e701e | 18 | /** |
masahikofukasawa | 0:7a00359e701e | 19 | * Destructor. |
masahikofukasawa | 0:7a00359e701e | 20 | * |
masahikofukasawa | 0:7a00359e701e | 21 | */ |
masahikofukasawa | 0:7a00359e701e | 22 | AkmHallSwitch::~AkmHallSwitch(){ |
masahikofukasawa | 0:7a00359e701e | 23 | sw1->rise(0); |
masahikofukasawa | 0:7a00359e701e | 24 | sw1->fall(0); |
masahikofukasawa | 0:7a00359e701e | 25 | sw0->rise(0); |
masahikofukasawa | 0:7a00359e701e | 26 | sw0->fall(0); |
masahikofukasawa | 0:7a00359e701e | 27 | |
masahikofukasawa | 0:7a00359e701e | 28 | if(sw0) delete sw0; |
masahikofukasawa | 0:7a00359e701e | 29 | if(sw1) delete sw1; |
masahikofukasawa | 0:7a00359e701e | 30 | } |
masahikofukasawa | 0:7a00359e701e | 31 | |
masahikofukasawa | 0:7a00359e701e | 32 | AkmSensor::Status AkmHallSwitch::init(const uint8_t id, const uint8_t subid){ |
masahikofukasawa | 0:7a00359e701e | 33 | primaryId = id; |
masahikofukasawa | 0:7a00359e701e | 34 | subId = subid; |
masahikofukasawa | 0:7a00359e701e | 35 | |
masahikofukasawa | 13:d008249f0359 | 36 | if(primaryId == AKM_PRIMARY_ID_UNIPOLAR && subId == AkmHallSwitch::SUB_ID_EM1771) sensorName = "EM-1771"; |
masahikofukasawa | 13:d008249f0359 | 37 | else if(primaryId == AKM_PRIMARY_ID_UNIPOLAR && subId == AkmHallSwitch::SUB_ID_EW453) sensorName = "EW-453"; |
masahikofukasawa | 13:d008249f0359 | 38 | else if(primaryId == AKM_PRIMARY_ID_UNIPOLAR && subId == AkmHallSwitch::SUB_ID_EW652B) sensorName = "EW-652B"; |
masahikofukasawa | 13:d008249f0359 | 39 | else if(primaryId == AKM_PRIMARY_ID_UNIPOLAR && subId == AkmHallSwitch::SUB_ID_EW6672) sensorName = "EW-6672"; |
masahikofukasawa | 13:d008249f0359 | 40 | else if(primaryId == AKM_PRIMARY_ID_OMNIPOLAR && subId == AkmHallSwitch::SUB_ID_EM1781) sensorName = "EM-1781"; |
masahikofukasawa | 13:d008249f0359 | 41 | else if(primaryId == AKM_PRIMARY_ID_OMNIPOLAR && subId == AkmHallSwitch::SUB_ID_AK8788A) sensorName = "AK8788A"; |
masahikofukasawa | 13:d008249f0359 | 42 | else if(primaryId == AKM_PRIMARY_ID_OMNIPOLAR && subId == AkmHallSwitch::SUB_ID_EM6781) sensorName = "EM-6781"; |
masahikofukasawa | 13:d008249f0359 | 43 | else if(primaryId == AKM_PRIMARY_ID_LATCH && subId == AkmHallSwitch::SUB_ID_AK8771) sensorName = "AK8771"; |
masahikofukasawa | 13:d008249f0359 | 44 | else if(primaryId == AKM_PRIMARY_ID_LATCH && subId == AkmHallSwitch::SUB_ID_EW432) sensorName = "EW-432"; |
masahikofukasawa | 13:d008249f0359 | 45 | else if(primaryId == AKM_PRIMARY_ID_LATCH && subId == AkmHallSwitch::SUB_ID_EZ470) sensorName = "EZ-470"; |
masahikofukasawa | 13:d008249f0359 | 46 | else if(primaryId == AKM_PRIMARY_ID_LATCH && subId == AkmHallSwitch::SUB_ID_EZ471) sensorName = "EZ-471"; |
masahikofukasawa | 13:d008249f0359 | 47 | else if(primaryId == AKM_PRIMARY_ID_LATCH && subId == AkmHallSwitch::SUB_ID_EW612B) sensorName = "EW-612B"; |
masahikofukasawa | 13:d008249f0359 | 48 | else if(primaryId == AKM_PRIMARY_ID_LATCH && subId == AkmHallSwitch::SUB_ID_EW632) sensorName = "EW-632"; |
masahikofukasawa | 13:d008249f0359 | 49 | else if(primaryId == AKM_PRIMARY_ID_DUAL_OUTPUT && subId == AkmHallSwitch::SUB_ID_EM1791) sensorName = "EM-1791"; |
masahikofukasawa | 13:d008249f0359 | 50 | else if(primaryId == AKM_PRIMARY_ID_DUAL_OUTPUT && subId == AkmHallSwitch::SUB_ID_AK8789) sensorName = "AK8789"; |
masahikofukasawa | 13:d008249f0359 | 51 | else if(primaryId == AKM_PRIMARY_ID_ONECHIP_ENCODER && subId == AkmHallSwitch::SUB_ID_AK8775) sensorName = "AK8775"; |
masahikofukasawa | 13:d008249f0359 | 52 | else if(primaryId == AKM_PRIMARY_ID_ONECHIP_ENCODER && subId == AkmHallSwitch::SUB_ID_AK8776) sensorName = "AK8776"; |
masahikofukasawa | 13:d008249f0359 | 53 | else if(primaryId == AKM_PRIMARY_ID_ONECHIP_ENCODER && subId == AkmHallSwitch::SUB_ID_AK8779A) sensorName = "AK8779A"; |
masahikofukasawa | 13:d008249f0359 | 54 | else if(primaryId == AKM_PRIMARY_ID_ONECHIP_ENCODER && subId == AkmHallSwitch::SUB_ID_AK8779B) sensorName = "AK8779B"; |
masahikofukasawa | 13:d008249f0359 | 55 | |
masahikofukasawa | 0:7a00359e701e | 56 | sw0 = new InterruptIn(DIGITAL_D0); |
masahikofukasawa | 0:7a00359e701e | 57 | sw1 = new InterruptIn(DIGITAL_D1); |
masahikofukasawa | 0:7a00359e701e | 58 | |
masahikofukasawa | 0:7a00359e701e | 59 | sw1->rise(0); |
masahikofukasawa | 0:7a00359e701e | 60 | sw1->fall(0); |
masahikofukasawa | 0:7a00359e701e | 61 | sw0->rise(0); |
masahikofukasawa | 0:7a00359e701e | 62 | sw0->fall(0); |
masahikofukasawa | 0:7a00359e701e | 63 | |
masahikofukasawa | 0:7a00359e701e | 64 | return AkmSensor::SUCCESS; |
masahikofukasawa | 0:7a00359e701e | 65 | } |
masahikofukasawa | 0:7a00359e701e | 66 | |
masahikofukasawa | 0:7a00359e701e | 67 | void AkmHallSwitch::riseEventD0(){ |
masahikofukasawa | 0:7a00359e701e | 68 | d0 = 1; |
masahikofukasawa | 29:b488d2c89fba | 69 | AkmSensor::setEvent(); |
masahikofukasawa | 0:7a00359e701e | 70 | } |
masahikofukasawa | 0:7a00359e701e | 71 | void AkmHallSwitch::fallEventD0(){ |
masahikofukasawa | 0:7a00359e701e | 72 | d0 = 0; |
masahikofukasawa | 29:b488d2c89fba | 73 | AkmSensor::setEvent(); |
masahikofukasawa | 0:7a00359e701e | 74 | } |
masahikofukasawa | 0:7a00359e701e | 75 | void AkmHallSwitch::riseEventD1(){ |
masahikofukasawa | 0:7a00359e701e | 76 | d1 = 1; |
masahikofukasawa | 29:b488d2c89fba | 77 | AkmSensor::setEvent(); |
masahikofukasawa | 0:7a00359e701e | 78 | } |
masahikofukasawa | 0:7a00359e701e | 79 | |
masahikofukasawa | 0:7a00359e701e | 80 | void AkmHallSwitch::fallEventD1(){ |
masahikofukasawa | 0:7a00359e701e | 81 | d1 = 0; |
masahikofukasawa | 29:b488d2c89fba | 82 | AkmSensor::setEvent(); |
masahikofukasawa | 0:7a00359e701e | 83 | } |
masahikofukasawa | 0:7a00359e701e | 84 | |
masahikofukasawa | 0:7a00359e701e | 85 | AkmSensor::Status AkmHallSwitch::startSensor(){ |
masahikofukasawa | 16:d85be9bafb80 | 86 | sw1->rise(callback(this, &AkmHallSwitch::riseEventD1)); |
masahikofukasawa | 16:d85be9bafb80 | 87 | sw1->fall(callback(this, &AkmHallSwitch::fallEventD1)); |
masahikofukasawa | 0:7a00359e701e | 88 | if(primaryId == AkmSensor::AKM_PRIMARY_ID_DUAL_OUTPUT || primaryId == AkmSensor::AKM_PRIMARY_ID_ONECHIP_ENCODER) |
masahikofukasawa | 0:7a00359e701e | 89 | { |
masahikofukasawa | 16:d85be9bafb80 | 90 | sw0->rise(callback(this, &AkmHallSwitch::riseEventD0)); |
masahikofukasawa | 16:d85be9bafb80 | 91 | sw0->fall(callback(this, &AkmHallSwitch::fallEventD0)); |
masahikofukasawa | 0:7a00359e701e | 92 | } |
masahikofukasawa | 29:b488d2c89fba | 93 | MSG("#Start sensor %s.\r\n",sensorName); |
masahikofukasawa | 0:7a00359e701e | 94 | return AkmSensor::SUCCESS; |
masahikofukasawa | 0:7a00359e701e | 95 | } |
masahikofukasawa | 0:7a00359e701e | 96 | |
masahikofukasawa | 0:7a00359e701e | 97 | AkmSensor::Status AkmHallSwitch::startSensor(const float sec){ |
masahikofukasawa | 11:cef8dc1cf010 | 98 | return AkmSensor::ERROR; |
masahikofukasawa | 0:7a00359e701e | 99 | } |
masahikofukasawa | 0:7a00359e701e | 100 | |
masahikofukasawa | 0:7a00359e701e | 101 | AkmSensor::Status AkmHallSwitch::stopSensor(){ |
masahikofukasawa | 0:7a00359e701e | 102 | sw1->rise(0); |
masahikofukasawa | 0:7a00359e701e | 103 | sw1->fall(0); |
masahikofukasawa | 0:7a00359e701e | 104 | sw0->rise(0); |
masahikofukasawa | 0:7a00359e701e | 105 | sw0->fall(0); |
masahikofukasawa | 0:7a00359e701e | 106 | return AkmSensor::SUCCESS; |
masahikofukasawa | 0:7a00359e701e | 107 | } |
masahikofukasawa | 0:7a00359e701e | 108 | |
masahikofukasawa | 0:7a00359e701e | 109 | AkmSensor::Status AkmHallSwitch::readSensorData(Message* msg){ |
masahikofukasawa | 29:b488d2c89fba | 110 | AkmSensor::clearEvent(); |
masahikofukasawa | 0:7a00359e701e | 111 | |
masahikofukasawa | 0:7a00359e701e | 112 | msg->setCommand(Message::CMD_START_MEASUREMENT); |
masahikofukasawa | 0:7a00359e701e | 113 | msg->setArgument( 0, d1 ? 1 : 0 ); |
masahikofukasawa | 0:7a00359e701e | 114 | if(primaryId == AkmSensor::AKM_PRIMARY_ID_DUAL_OUTPUT || primaryId == AkmSensor::AKM_PRIMARY_ID_ONECHIP_ENCODER) |
masahikofukasawa | 0:7a00359e701e | 115 | { |
masahikofukasawa | 0:7a00359e701e | 116 | msg->setArgument( 1, d0 ? 1 : 0 ); |
masahikofukasawa | 0:7a00359e701e | 117 | } |
masahikofukasawa | 0:7a00359e701e | 118 | return AkmSensor::SUCCESS; |
masahikofukasawa | 0:7a00359e701e | 119 | } |
masahikofukasawa | 0:7a00359e701e | 120 | |
masahikofukasawa | 0:7a00359e701e | 121 | AkmSensor::Status AkmHallSwitch::requestCommand(Message* in, Message* out){ |
masahikofukasawa | 15:1238993fd75f | 122 | return AkmSensor::ERROR; |
masahikofukasawa | 0:7a00359e701e | 123 | } |