#include <fstream>
#include <iostream>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <termios.h>
#include <unistd.h>

using namespace std;

int main(void)
{
	// Open input and output streams
	ifstream ilaser("/dev/ttyS0");
	ofstream olaser("/dev/ttyS0");

	// Send command to laser to stop taking data,
	// set the sample rate to 330 milliseconds/sample,
	// and print the configuration information.
	olaser<<"H2.S330.V1234."<<endl;

	// Loop while reading lines of config info from laser
	for (int i=0; i<15; i++) {
		string line;
		getline(ilaser, line);
		cout <<line << endl;
		if(line.find("SAMPLE PRIORITY") != string::npos)break;
	}
	cout << " ================= "<< endl;
	
	// Tell laser to start reporting data again
	olaser<<"H1."<<endl;

	// Print 10 samples to screen
	cout<<"Printing 10 samples:"<<endl;
	for(int i=0; i<10; i++){
		string line;
		getline(ilaser, line);
		cout <<line << endl;
	}
	cout<<"----- All done ----"<<endl;

	// Close input and output streams
	olaser.close();
	ilaser.close();

	return 1;
}