// Test PFS receiver

#include "IVMeter-lib.nxc"

#define VoltMeterAddr 0x26
#define CurrentMeterAddr 0x28

#define IRLink S1
#define VoltPort S2
#define AmpPort S3

#define FILE_NAME "data.csv"
#define FILE_SIZE 10000

task main()
{

  SetSensorLowspeed(IRLink);
  SetSensorLowspeed(VoltPort);
  SetSensorLowspeed(AmpPort);
  
  // Init log file
  byte handle;
  unsigned int result, cnt;
  string s;

  long t;
  long t0=CurrentTick();

  // Start motor
  HTPFComboDirect(IRLink, PF_CHANNEL_1, PF_CMD_FWD , PF_CMD_FWD );
  Wait(500);
  
  HTPFComboDirect(IRLink, PF_CHANNEL_1, PF_CMD_BRAKE , PF_CMD_BRAKE );
  NumOut(0, LCD_LINE2, IV_ReadCalibrated(VoltPort, VoltMeterAddr));
  NumOut(0, LCD_LINE3, IV_ReadCalibrated(AmpPort, CurrentMeterAddr));
  PlayTone(400, 200);
  Wait(10000);
}