kusano kiyoshige / Mbed 2 deprecated 17robo_fuzi

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   QEI accelerator bit_test cyclic_io cyclic_var cylinder event_var limit mbed mecanum motor_drive pid pid_encoder rs422_put sbdbt servo

Fork of 17robo_Practice1 by kusano kiyoshige

Files at this revision

API Documentation at this revision

Revision 24:da0fc94add43, committed 2017-08-06

Comitter:
echo_piyo
Date:
Sun Aug 06 02:01:23 2017 +0000
Parent:
23:aeff5fd36ae1
Child:
25:124aee8a7742
Commit message:
(?)?????? MecanumPower???????????

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file 
--- a/main.cpp	Sat Aug 05 04:23:30 2017 +0000
+++ b/main.cpp	Sun Aug 06 02:01:23 2017 +0000
@@ -42,6 +42,7 @@
 #define enc_Kp      0.01
 #define enc_Ki      0.01
 #define enc_Kd      0.01
+#define powerdown   0.6
 
 DigitalOut led1(LED1);
 //DigitalOut led2(LED2);
@@ -122,11 +123,11 @@
 
     switch (counter) {
         case 0:
-            rs422.put(id[counter], v1.duty(mecanum.v1()), v3.duty(mecanum.v3()));
+            rs422.put(id[counter], v1.duty(mecanum.v1()*powerdown), v3.duty(mecanum.v3()*powerdown));
             counter++;
             break;
         case 1:
-            rs422.put(id[counter], v2.duty(mecanum.v2()), v4.duty(mecanum.v4()));
+            rs422.put(id[counter], v2.duty(mecanum.v2()*powerdown), v4.duty(mecanum.v4()*powerdown));
             counter ++;
             break;
         case 2:
@@ -134,11 +135,11 @@
             counter ++;
             break;
         case 3:
-            rs422.put(id[counter], (sbdbt.sankaku*0.5-sbdbt.batu*0.5), (sbdbt.up*0.5-sbdbt.down*0.5) );
+            rs422.put(id[counter], (-sbdbt.sankaku*0.8+sbdbt.batu*0.8), (sbdbt.up*0.8-sbdbt.down*0.8));
             counter ++;
             break;
         case 4:
-            rs422.put(id[counter], ((float)sword_left.getState()),0.0);
+            rs422.put(id[counter], ((float)sword_right.getState()*0.8),((float)sword_left.getState()*0.8));
             counter = 0;
             break;
         default: