Modified for compatibility with Rev.E. hardware
Fork of AkmSensor by
Diff: ak7401ctrl.cpp
- Revision:
- 39:3821886c902e
- Parent:
- 30:5a241d9b3262
- Child:
- 43:45225713cd58
--- a/ak7401ctrl.cpp Thu Jun 08 19:09:18 2017 +0000 +++ b/ak7401ctrl.cpp Tue Jul 18 23:20:26 2017 +0000 @@ -133,7 +133,7 @@ char abnormal = 0x00; if( ak7401->readAngleMeasureCommand(angle, &density, &abnormal) != AK7401::SUCCESS ){ - MSG("#Error read angle\r\n"); + MSG("#Error: Read angle\r\n"); status = AkmSensor::ERROR; } out->setCommand(Message::CMD_ANGLE_READ); @@ -146,7 +146,7 @@ case Message::CMD_ANGLE_ZERO_RESET: { if( ak7401->setAngleZero() != AK7401::SUCCESS ){ - MSG("#Error set angle zero\r\n"); + MSG("#Error: Set angle zero\r\n"); status = AkmSensor::ERROR; } if( status == AkmSensor::ERROR ){ @@ -162,12 +162,12 @@ char address = in->getArgument(0); int len = in->getArgument(1); if(len != 2){ - MSG("#Error length=%d. Only support 2byte length\r\n",len); + MSG("#Error: length=%d. Only support 2byte length\r\n",len); status = AkmSensor::ERROR; return status; } if(in->getArgNum() != len+2){ - MSG("#Error argument num. Args=%d\r\n",in->getArgNum()); + MSG("#Error: Argument num. Args=%d\r\n",in->getArgNum()); status = AkmSensor::ERROR; out->setArgument(0,(char)status); return status; @@ -179,11 +179,11 @@ } if( ak7401->writeRegister(address, data) != AK7401::SUCCESS) { status = AkmSensor::ERROR; - MSG("#Error register write.\r\n"); + MSG("#Error: Register write.\r\n"); } if( ak7401->writeEEPROM(address, data) != AK7401::SUCCESS) { status = AkmSensor::ERROR; - MSG("#Error EEPROM write.\r\n"); + MSG("#Error: EEPROM write.\r\n"); } out->setArgument(0,(char)status); break; @@ -192,7 +192,7 @@ case Message::CMD_REG_READN: { if(in->getArgNum() != 2){ - MSG("#Error argument num. Args=%d\r\n",in->getArgNum()); + MSG("#Error: argument num. Args=%d\r\n",in->getArgNum()); status = AkmSensor::ERROR; return status; } @@ -200,14 +200,14 @@ char address = in->getArgument(0); int len = in->getArgument(1); if(len != 2){ - MSG("#Error length=%d. Only support 2byte length\r\n",len); + MSG("#Error: length=%d. Only support 2byte length\r\n",len); status = AkmSensor::ERROR; return status; } char data[len]; if( ak7401->readRegister(address, data) != AK7401::SUCCESS) { status = AkmSensor::ERROR; - MSG("#Error register read.\r\n"); + MSG("#Error: register read.\r\n"); } for(int i=0; i<len; i++){ out->setArgument(i, data[i]); @@ -216,7 +216,7 @@ } default: { - MSG("#Error no command.\r\n"); + MSG("#Error: no command.\r\n"); status = AkmSensor::ERROR; break; }