![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
pepe
Communication.cpp
- Committer:
- PedroMartins96
- Date:
- 2019-03-13
- Revision:
- 0:a7324f51348d
- Child:
- 1:2716ea33958b
File content as of revision 0:a7324f51348d:
#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()); }