18 #ifndef ROS_EMBEDDED_LINUX_HARDWARE_H_ 19 #define ROS_EMBEDDED_LINUX_HARDWARE_H_ 23 #ifdef BUILD_LIBROSSERIALEMBEDDEDLINUX 24 extern "C" int elCommInit(
char *portName,
int baud);
26 extern "C" elCommWrite(
int fd, uint8_t* data,
int length);
29 #define DEFAULT_PORT "/dev/ttyAM1" 42 const char *envPortName = getenv(
"ROSSERIAL_PORT");
43 if (envPortName == NULL)
66 std::cout <<
"Exiting" << std::endl;
69 std::cout <<
"EmbeddedHardware.h: opened serial port successfully\n";
70 clock_gettime(CLOCK_MONOTONIC, &
start);
73 void init(
const char *pName)
78 std::cout <<
"Exiting" << std::endl;
81 std::cout <<
"EmbeddedHardware.h: opened comm port successfully\n";
82 clock_gettime(CLOCK_MONOTONIC, &
start);
91 void write(uint8_t* data,
int length)
98 long millis, seconds, nseconds;
100 clock_gettime(CLOCK_MONOTONIC, &
end);
102 seconds =
end.tv_sec -
start.tv_sec;
103 nseconds =
end.tv_nsec -
start.tv_nsec;
105 millis = ((seconds) * 1000 + nseconds / 1000000.0) + 0.5;
struct timespec start end
void init(const char *pName)
int elCommWrite(int fd, uint8_t *data, int len)
void write(uint8_t *data, int length)
EmbeddedLinuxHardware(const char *pn, long baud=57600)
int elCommInit(const char *portName, int baud)