Francisco Santos
/
SRA_VFF
pepe
Communication.cpp
- Committer:
- FJMS
- Date:
- 2019-11-24
- Revision:
- 2:06b7789c7da0
- Parent:
- 1:2716ea33958b
File content as of revision 2:06b7789c7da0:
#include "Communication.h" #include "mbed.h" #include "MessageBuilder.h" const char max_len = 30; Serial *serial_object; MessageBuilder bin_msg; void init_communication(Serial *serial_in) { serial_object = serial_in; } void write_bytes(char *ptr, unsigned char len) { for(int i=0; i<len; i++) { serial_object->putc(ptr[i]); } } void send_odometry(int value1, int value2, int ticks_left, int ticks_right, float x, float y, float theta) { bin_msg.reset(); bin_msg.add('O'); bin_msg.add(value1); bin_msg.add(value2); bin_msg.add(ticks_left); bin_msg.add(ticks_right); bin_msg.add(x); bin_msg.add(y); bin_msg.add(theta); write_bytes(bin_msg.message, bin_msg.length()); }