sub2 MDC and enc
Dependencies: 2022_NHK_B_canTR FEP_RX22 QEI ikarashiMDC_2byte_ver mbed HOSOKIkikou R1370 SEKIkikou
Revision 8:cccc03be9714, committed 2022-10-13
- Comitter:
- umekou
- Date:
- Thu Oct 13 03:24:48 2022 +0000
- Parent:
- 7:4e43530672df
- Commit message:
- del unuse comments
Changed in this revision
| main.cpp | Show annotated file Show diff for this revision Revisions of this file |
--- a/main.cpp Thu Oct 13 03:23:21 2022 +0000
+++ b/main.cpp Thu Oct 13 03:24:48 2022 +0000
@@ -75,63 +75,16 @@
for(int i=0; i < 8; i++){
motor[i].setSpeed(0);
}
-// int bc=0,bn=0;
-// int currentMode=1;
+
HOSOKIkikou hosoki(&motor[6],&motor[7], &motor[4], &motor[5], &b[4], NULL, NULL, NULL, NULL, NULL);
while(1) {
// recieveController();
Reset=0;
updateenc();
updatejyro();
- /*
- bc=b[7]-bn;
- bn=b[7];
-
- if(currentMode==1){
- if(bc==1){
- currentMode=2;
- led = 1;
- hosoki.stopAll();
- }
- }else if(currentMode==2){
- if(bc==1){
- currentMode=3;
- led = 0;
- hosoki.init(&motor[6],&motor[7], &motor[4], &motor[5], &b[0], &b[1], &b[2], &b[3], &encoderValue[2], &encoderValue[3]);
- }
- }else if(currentMode==3){
- if(bc==1){
- currentMode=1;
- led = 1;
- hosoki.stopAll();
- }else{
- hosoki.runAll(-0.9,0.9,0.3,0.3);
- }
- }
- */
canTR();
- /*
- if(stick[2]>80||stick[2]<-80||stick[3]>80||stick[3]<-80){//機構回転
- if(stick[2]>80){
- motorSpeed[1] = 0.5;
- }else if(stick[2]<-80){
- motorSpeed[1] = -0.5;
- }
- if(stick[3]>100){
- motorSpeed[2] = 0.8;
- }else if(stick[3]<-100){
- motorSpeed[2] = -0.8;
- }
- } else {
- motorSpeed[2]=0;
- motorSpeed[1]=0;
- }*/
hosoki.runAll(-0.9,0.9,0,0);
-
-// for(int i=1; i < 3; i++){
-// motor[i].setSpeed(motorSpeed[i]);
-// }
-
+
pc.printf("|wheel: ");
for(int i=8; i < 12; i++){
pc.printf("%.2f ",motorSpeed[i]);