taiyou komazawa / DataPool

Dependencies:   Gamma Beta Alpha

Dependents:   2017_Bteam_I2CTransporter BETA_A ALPHA_A GAMMA_A

Committer:
Komazawa_sun
Date:
Wed Aug 16 07:02:54 2017 +0000
Revision:
1:47ea89b6364e
Parent:
0:52b800fb3844
hogehoge

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Komazawa_sun 0:52b800fb3844 1 #include "GammaPool.h"
Komazawa_sun 0:52b800fb3844 2
Komazawa_sun 0:52b800fb3844 3 GammaPool::GammaPool()
Komazawa_sun 0:52b800fb3844 4 : _master(SDA, SCL)
Komazawa_sun 0:52b800fb3844 5 {
Komazawa_sun 1:47ea89b6364e 6 data_index[0] = ctrl.rx;
Komazawa_sun 1:47ea89b6364e 7 data_index[1] = ctrl.ry;
Komazawa_sun 1:47ea89b6364e 8 data_index[2] = ctrl.lx;
Komazawa_sun 1:47ea89b6364e 9 data_index[3] = ctrl.r_sw1;
Komazawa_sun 1:47ea89b6364e 10 data_index[4] = ctrl.r_sw2;
Komazawa_sun 1:47ea89b6364e 11 data_index[5] = ctrl.r_sw3;
Komazawa_sun 1:47ea89b6364e 12 data_index[6] = ctrl.r_sw4;
Komazawa_sun 1:47ea89b6364e 13 data_index[7] = ctrl.r_s_sw1;
Komazawa_sun 1:47ea89b6364e 14 data_index[8] = ctrl.r_s_sw2;
Komazawa_sun 1:47ea89b6364e 15 data_index[9] = ctrl.l_sw1;
Komazawa_sun 1:47ea89b6364e 16 data_index[10] = ctrl.l_sw2;
Komazawa_sun 1:47ea89b6364e 17 data_index[11] = ctrl.l_sw3;
Komazawa_sun 1:47ea89b6364e 18 data_index[12] = ctrl.l_sw4;
Komazawa_sun 1:47ea89b6364e 19 data_index[13] = ctrl.l_s_sw1;
Komazawa_sun 1:47ea89b6364e 20 data_index[14] = ctrl.l_s_sw2;
Komazawa_sun 1:47ea89b6364e 21 data_index[15] = ctrl.mode1;
Komazawa_sun 1:47ea89b6364e 22 data_index[16] = ctrl.mode2;
Komazawa_sun 1:47ea89b6364e 23 data_index[17] = ctrl.r_srd;
Komazawa_sun 1:47ea89b6364e 24 data_index[18] = ctrl.l_srd;
Komazawa_sun 1:47ea89b6364e 25 data_index[19] = ar.r.max_limit;
Komazawa_sun 1:47ea89b6364e 26 data_index[20] = ar.r.min_limit;
Komazawa_sun 1:47ea89b6364e 27 data_index[21] = ar.l.max_limit;
Komazawa_sun 1:47ea89b6364e 28 data_index[22] = ar.l.min_limit;
Komazawa_sun 0:52b800fb3844 29 }
Komazawa_sun 0:52b800fb3844 30
Komazawa_sun 0:52b800fb3844 31 bool GammaPool::set()
Komazawa_sun 0:52b800fb3844 32 {
Komazawa_sun 0:52b800fb3844 33 bool error = true;
Komazawa_sun 0:52b800fb3844 34 /*_master.transport(0, JUSHINKUN_ADDR, 0, ctrl.all_data, 10);
Komazawa_sun 0:52b800fb3844 35 _master.transport(APPER_BODY_ADDR, TspMode::send, r.all_data, 4);
Komazawa_sun 0:52b800fb3844 36 _master.transport(APPER_BODY_ADDR, TspMode::reseive, r.all_data, 1);*/
Komazawa_sun 0:52b800fb3844 37
Komazawa_sun 0:52b800fb3844 38 error &= ~_master.read(JUSHINKUN_ADDR, ctrl.all_data, 10);
Komazawa_sun 0:52b800fb3844 39 error &= ~_master.write(APPER_BODY_ADDR, a.all_data, 4);
Komazawa_sun 0:52b800fb3844 40 error &= ~_master.read(JUSHINKUN_ADDR, ar.all_data, 1);
Komazawa_sun 0:52b800fb3844 41
Komazawa_sun 0:52b800fb3844 42 return error;
Komazawa_sun 0:52b800fb3844 43 }
Komazawa_sun 1:47ea89b6364e 44
Komazawa_sun 1:47ea89b6364e 45 int GammaPool::read(int index_num)
Komazawa_sun 1:47ea89b6364e 46 {
Komazawa_sun 1:47ea89b6364e 47 return data_index[index_num];
Komazawa_sun 1:47ea89b6364e 48 }
Komazawa_sun 1:47ea89b6364e 49
Komazawa_sun 0:52b800fb3844 50 void GammaPool::reset(){
Komazawa_sun 0:52b800fb3844 51 for(int t = 0; t < 10; t++)
Komazawa_sun 0:52b800fb3844 52 ctrl.all_data[t] = 0;
Komazawa_sun 0:52b800fb3844 53 for(int t = 0; t < 4; t++)
Komazawa_sun 0:52b800fb3844 54 a.all_data[t] = 0;
Komazawa_sun 0:52b800fb3844 55 ar.all_data[0] = 0;
Komazawa_sun 0:52b800fb3844 56 }