NagaokaRoboticsClub_mbedTeam / DataControl

binary

DataControl.cpp@3:78735753b3cc, 2022-10-06 (annotated)

Committer:
ikarashikota
Date:
Thu Oct 06 23:33:23 2022 +0000
Revision:
3:78735753b3cc
Parent:
2:d8bfeadb944e 
fixed

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ikarashikota 0:65149aeacbcc 1
ikarashikota 0:65149aeacbcc 2 #include "DataControl.h"
ikarashikota 0:65149aeacbcc 3
ikarashikota 0:65149aeacbcc 4 DataControl::DataControl()
ikarashikota 0:65149aeacbcc 5 {
ikarashikota 0:65149aeacbcc 6 separated_data_size = 0;
ikarashikota 0:65149aeacbcc 7 for(int i=0; i<5; i++) dataBuff[i] = 0;
ikarashikota 0:65149aeacbcc 8 }
ikarashikota 0:65149aeacbcc 9
ikarashikota 0:65149aeacbcc 10
ikarashikota 1:d37d53d33f0d 11 /*---bit cotrol---*/
ikarashikota 0:65149aeacbcc 12
ikarashikota 0:65149aeacbcc 13 void DataControl::dataSeparate(uint16_t data, char* array)
ikarashikota 0:65149aeacbcc 14 {
ikarashikota 0:65149aeacbcc 15 array[0] = data & 0xFF;
ikarashikota 0:65149aeacbcc 16 array[1] = (data & 0xFF00) >> 8;
ikarashikota 0:65149aeacbcc 17 }
ikarashikota 0:65149aeacbcc 18
ikarashikota 1:d37d53d33f0d 19 int DataControl::dataCombine(unsigned char *array, int _data_size)
ikarashikota 1:d37d53d33f0d 20 {
ikarashikota 0:65149aeacbcc 21 for(int i=0; i<5; i++) dataBuff[i] = 0;
ikarashikota 2:d8bfeadb944e 22 for(int i=0; i<_data_size-1; i++) {
ikarashikota 0:65149aeacbcc 23 dataBuff[i] = array[i];
ikarashikota 0:65149aeacbcc 24 dataBuff[4] |= dataBuff[i] << (i*8);
ikarashikota 0:65149aeacbcc 25 }
ikarashikota 0:65149aeacbcc 26 return dataBuff[4];
ikarashikota 0:65149aeacbcc 27 }
ikarashikota 0:65149aeacbcc 28
ikarashikota 1:d37d53d33f0d 29 /*---end---*/
ikarashikota 0:65149aeacbcc 30
ikarashikota 0:65149aeacbcc 31
ikarashikota 0:65149aeacbcc 32
ikarashikota 1:d37d53d33f0d 33 /*---dataSet function---*/
ikarashikota 1:d37d53d33f0d 34
ikarashikota 0:65149aeacbcc 35 void DataControl::dataSet(int data, char *data_array)
ikarashikota 0:65149aeacbcc 36 {
ikarashikota 3:78735753b3cc 37 separated_data_size = sizeof(data) + 1; // 4
ikarashikota 0:65149aeacbcc 38 dataSeparate(data & 0xFFFF, data_array);
ikarashikota 0:65149aeacbcc 39 dataSeparate((data & 0xFFFF0000) >> 16, &data_array[2]);
ikarashikota 0:65149aeacbcc 40 }
ikarashikota 0:65149aeacbcc 41
ikarashikota 0:65149aeacbcc 42
ikarashikota 0:65149aeacbcc 43 void DataControl::dataSet(uint16_t data, char *data_array)
ikarashikota 0:65149aeacbcc 44 {
ikarashikota 3:78735753b3cc 45 separated_data_size = sizeof(data) + 1; // 2
ikarashikota 0:65149aeacbcc 46 dataSeparate(data, data_array);
ikarashikota 0:65149aeacbcc 47 }
ikarashikota 1:d37d53d33f0d 48
ikarashikota 1:d37d53d33f0d 49 void DataControl::dataSet(char data, char *data_array)
ikarashikota 1:d37d53d33f0d 50 {
ikarashikota 3:78735753b3cc 51 separated_data_size = sizeof(data) + 1; // 1
ikarashikota 1:d37d53d33f0d 52 data_array[0] = data;
ikarashikota 1:d37d53d33f0d 53 }
ikarashikota 1:d37d53d33f0d 54
ikarashikota 2:d8bfeadb944e 55
ikarashikota 1:d37d53d33f0d 56 /*---end---*/