Modified for compatibility with Rev.E. hardware

Fork of AkmSensor by AKM Development Platform

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;
         }