void messaging_onMessageRead(unsigned char messageCode, unsigned char* parametersBuffer, unsigned short parametersBytesRead)
{
switch((unsigned short) messageCode)
{
case MESSAGE_CODE_TEST_CONNECTION:
testChannel();
break;
case MESSAGE_CODE_GET_VALUE_FROM_ULTRASONIC_SENSOR:
getValueFromUltrasonicSensor(parametersBuffer[0]);
break;
case MESSAGE_CODE_GET_VALUES_FROM_MAGNETOMETER:
getValuesFromMagnetometer();
break;
case MESSAGE_CODE_GET_VALUES_FROM_ACCELEROMETER:
getValuesFromAccelerometer();
break;
case MESSAGE_CODE_GET_VALUES_FROM_GYROSCOPE:
getValuesFromGyroscope();
break;
case MESSAGE_CODE_GET_BATTERY_VOLTAGE:
getBatteryVoltage();
break;
case MESSAGE_CODE_GET_CHARGER_VOLTAGE:
getChargerVoltage();
break;
case MESSAGE_CODE_CHANGE_MOTOR_STATE:
changeMotorState(parametersBuffer[0], parametersBuffer[1]);
break;
}
}
MAD_STATUS madDspVct_linkdown
(
IN MAD_DEV *dev,
IN MAD_LPORT port,
OUT MAD_DSP_VCT_RESULT_STRUCT *madDspVctResultP
)
{
int k = 0;
int l = 0;
char sw[64];
MAD_STATUS retVal;
MAD_U8 hwPort;
MAD_CRITIC_INFO("@@@ Start madDspVct_linkdown (hold, and no pending mode) collect data \n");
hwPort = MAD_LPORT_2_PORT(port);
if(!(MAD_DEV_PORT_CHECK(dev, hwPort)))
{
MAD_DBG_INFO("The port %d is over range.\n", (int)port);
return MAD_API_ERROR_OVER_PORT_RANGE;
}
if( !MAD_DEV_CAPABILITY(dev, MAD_PHY_DSP_VCT) ||
!MAD_DEV_HWMODE(dev, hwPort, MAD_PHY_MODE_COPPER) )
{
MAD_DBG_ERROR("DSP VCT not supported.\n");
return MAD_API_DSPVCT_NOT_SUPPORT;
}
for(k = 0; k <1; k++)
{
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xfc, 24,0x9555)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xfc, 25,0x9575)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xff, 17,0xdc0c)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xff, 16,0x2159)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xff, 17,0x0088)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xff, 16,0x215d)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xff, 17,0x8906)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xff, 16,0x215b)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xff, 17,0x2148)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xff, 16,0x2144)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xff, 17,0x8034)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xff, 16,0x2141)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0xfb, 8,0x3606)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0, 16,0x3070)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
if((retVal = madHwWritePagedPhyReg(dev, hwPort,0, 0,0x9140)) != MAD_OK)
{
MAD_DBG_ERROR("Reading from paged phy reg failed.\n");
return retVal;
}
retVal = testChannel(dev, hwPort, sw, k, madDspVctResultP);
}
MAD_DBG_INFO("Exception ! File Syntax Error or Runtime Error!\n");
return retVal;
}
