#pragma config stuffs.... this takes up a lot of room so i deleted it but its not the issue

// HiTechnic Gyroscopic Sensor Driver
#include "../#include/HTGYRO-driver.h"

// LEGO Ultrasound Sensor driver for use with sensor multiplexer
#include "../#include/LEGOUS-driver.h"

void initializeRobot(){                                                           // Set value of motor encoder for linear motor to 0
  HTSMUXinit();                                                                   // Initialize driver for Sensor Multiplexer                                                         
  HTSMUXscanPorts(HTSMUX);                                               // Scan ports of Sensor Multiplexer
  return;                                                                             // Continue with program
}


//1st attempt at getting this to work, this gives me one value for distArray[0] but its actually the value for msensor_s3_4??? and everything else is 0 which makes no sense at all.

int *readDist(){
  int distArray[4];
  distArray[0] = USreadDist(msensor_S3_1);
  distArray[1] = USreadDist(msensor_S3_2);
  distArray[2] = USreadDist(msensor_S3_3);
  distArray[3] = USreadDist(msensor_S3_4);
  return distArray;
}

//2nd Attempt: this gives me valuese for all 4 sensors but the values are all for msensor_s3_1 except that the 3rd value is the dist +1 and the 4th value is the dist +2.... so if the distance is 7 you get {7,7,8,9}

void readDist2(int *distPtr){
  distPtr = USreadDist(msensor_S3_1);
  distPtr++;
  distPtr = USreadDist(msensor_S3_2);
  distPtr++;
  distPtr = USreadDist(msensor_S3_3);
  distPtr++;
  distPtr = USreadDist(msensor_S3_4);
}

#define MODE 2

task main () {

  int distArray[4];
  initializeRobot();
  while(true) {
    if(MODE == 2)
    {
// This method works fine....
      int distFront = USreadDist(msensor_S3_1);
      int distRight = USreadDist(msensor_S3_2);
      int distBack = USreadDist(msensor_S3_3);
      int distLeft = USreadDist(msensor_S3_4);
      nxtDisplayTextLine(3, "Dist Front:  %3d cm", distFront);
      nxtDisplayTextLine(4, "Dist Right:  %3d cm", distRight);
      nxtDisplayTextLine(5, "Dist Back:  %3d cm", distBack);
      nxtDisplayTextLine(6, "Dist Left:  %3d cm", distLeft);
    }else if(MODE == 1)
    {
 // This method give me the {7,7,8,9}
      int *distPtr=readDist();
      nxtDisplayTextLine(3, "Dist Front:  %3d cm", distPtr);
      nxtDisplayTextLine(4, "Dist Right:  %3d cm", distPtr++);
      nxtDisplayTextLine(5, "Dist Back:  %3d cm", distPtr++);
      nxtDisplayTextLine(6, "Dist Left:  %3d cm", distPtr++);
    }else if(MODE == 0)
    {
//and this method gives me only 1 value
      readDist2(distArray);
      nxtDisplayTextLine(3, "Dist Front:  %3d cm", distArray[0]);
      nxtDisplayTextLine(4, "Dist Right:  %3d cm", distArray[1]);
      nxtDisplayTextLine(5, "Dist Back:  %3d cm", distArray[2]);
      nxtDisplayTextLine(6, "Dist Left:  %3d cm", distArray[3]);
    }
  }
}

typedef struct _USArray
{
    int USValues[4];
} US_ARRAY;

void ReadSensors(US_ARRAY &array)
{
    array.USValues[0] = USreadDist(msensor_S3_1);
    array.USValues[1] = USreadDist(msensor_S3_2);
    array.USValues[2] = USreadDist(msensor_S3_3);
    array.USValues[3] = USreadDIst(msensor_S3_4);
}

task main()
{
    US_ARRAY USSensors;

    ReadSensors(USSensors);
}

#pragma config(Sensor, S1,     HTSMUX,              sensorI2CCustom9V)
//*!!Code automatically generated by 'ROBOTC' configuration wizard               !!*//

#include "drivers/common.h"

// HiTechnic Gyroscopic Sensor Driver
#include "drivers/HTGYRO-driver.h"

// LEGO Ultrasound Sensor driver for use with sensor multiplexer
#include "drivers/LEGOUS-driver.h"

void initializeRobot(){                                                           // Set value of motor encoder for linear motor to 0
  HTSMUXinit();                                                                   // Initialize driver for Sensor Multiplexer
  HTSMUXscanPorts(HTSMUX);                                               // Scan ports of Sensor Multiplexer
  return;                                                                             // Continue with program
}

typedef int tDistArr[4];

//1st attempt at getting this to work, this gives me one value for distArray[0] but its actually the value for msensor_s3_4??? and everything else is 0 which makes no sense at all.

void readDist(tDistArr &distarr){
  distarr[0] = USreadDist(msensor_S3_1);
  distarr[1] = USreadDist(msensor_S3_2);
  distarr[2] = USreadDist(msensor_S3_3);
  distarr[3] = USreadDist(msensor_S3_4);
}

task main () {
  tDistArr distArray;
  initializeRobot();
  while(true) {
    readDist(distArray);
    nxtDisplayTextLine(3, "Dist Front:  %3d cm", distArray[0]);
    nxtDisplayTextLine(4, "Dist Right:  %3d cm", distArray[1]);
    nxtDisplayTextLine(5, "Dist Back:  %3d cm", distArray[2]);
    nxtDisplayTextLine(6, "Dist Left:  %3d cm", distArray[3]);
  }
}

int array[5] = {0, 1, 2, 3, 4};

void myFunction(int * arrayParm)
{
   nxtDisplayTextLine(0, "%d", arrayParm[0]);
   nxtDisplayTextLine(1, "%d", arrayParm[1]);
   nxtDisplayTextLine(2, "%d", arrayParm[2]);
   nxtDisplayTextLine(3, "%d", arrayParm[3]);
   nxtDisplayTextLine(4, "%d", arrayParm[4]);
}

task main()
{
   myFunction(array);
   while (true);
}