
test
Diff: ros_lib_melodic/MbedHardware.h
- Revision:
- 10:0b7f23df690a
- Parent:
- 9:859bcb293e46
- Child:
- 11:32eeb052cda5
--- a/ros_lib_melodic/MbedHardware.h Thu Jul 30 13:04:10 2020 +0000 +++ /dev/null Thu Jan 01 00:00:00 1970 +0000 @@ -1,60 +0,0 @@ -/* - * MbedHardware - * - * Created on: Aug 17, 2011 - * Author: nucho - */ - -#ifndef ROS_MBED_HARDWARE_H_ -#define ROS_MBED_HARDWARE_H_ - -#include "mbed.h" - -#include "BufferedSerial.h" - -class MbedHardware { - public: - MbedHardware(PinName tx, PinName rx, long baud = 57600) - :iostream(tx, rx){ - baud_ = baud; - t.start(); - } - - MbedHardware() - :iostream(USBTX, USBRX) { - baud_ = 57600; - t.start(); - } - - void setBaud(long baud){ - this->baud_= baud; - } - - int getBaud(){return baud_;} - - void init(){ - iostream.baud(baud_); - } - - int read(){ - if (iostream.readable()) { - return iostream.getc(); - } else { - return -1; - } - }; - void write(uint8_t* data, int length) { - for (int i=0; i<length; i++) - iostream.putc(data[i]); - } - - unsigned long time(){return t.read_ms();} - -protected: - BufferedSerial iostream; - long baud_; - Timer t; -}; - - -#endif /* ROS_MBED_HARDWARE_H_ */