部内対抗C班 / Mbed 2 deprecated self_position_expectation

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers SPE.h Source File

SPE.h

00001 #include "mbed.h"
00002 #include "math.h"
00003 #define PHI 38
00004 Int X=0;
00005 Int Y=0;
00006 void XY(double dx,double dy,int w){
00007  ddx=(dx*cos(w-45)+dy*(-1)*sin(w-45))*FI*PI*2.0/500.0;
00008  ddy=(dx*sin(w-45)+(dy*cos(w-45))*FI*PI*2.0/500.0;
00009  X=+ddx;
00010  Y=+ddy;
00011  }
00012