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: DriveConroller IMU MDD Mycan Odometer PID RotaryEncoder UART USS mbed
Fork of AR_MastarNode by
hardwareConfig.h
- Committer:
- TanakaTarou
- Date:
- 2018-08-17
- Revision:
- 6:a102603c99fd
- Parent:
- 3:6b4adb4d7101
- Child:
- 9:ce5a1315fe0d
File content as of revision 6:a102603c99fd:
//オンボードLEDの使用宣言
DigitalOut LED[] = {DigitalOut(LED1),
DigitalOut(LED2),
DigitalOut(LED3),
DigitalOut(LED4),
};
//デバック用シリアル
Serial pc(USBTX, USBRX);
Serial XBEE(p28, p27);
//CAN用 (rd, td)
Mycan can(p30, p29);
//sbus用 (tx, rx)
SBUS sbus(p13, p14);
//メカナム逆運動学モデルのヤコビアン
float jacobian[4][3] = {{ 1, -1, -1},
{ 1, 1, -1},
{-1, 1, -1},
{-1, -1, -1}
};
//(逆運動学モデル, ホイールの計算100%定義)
DriveController mecanum(jacobian, 0.95);
//(計算周期時間[s], sla, sld)
IMU imu(0.005, p9, p10);
//(pwmPin, direPin)
MDD Motor[4] = { MDD(p22, p21),
MDD(p24, p23),
MDD(p25, p20),
MDD(p26, p19)
};
Timer timer;
//(A相, B相)
RotaryEncoder enc[3] = {RotaryEncoder(p5 , p6 , &timer, 400),
RotaryEncoder(p18, p17, &timer, 100),
RotaryEncoder(p16, p15, &timer, 100),
};
DigitalIn sw1(p8);
DigitalIn sw2(p7);
//(trig, echo)
USS uss(p11, p12);
//コントローラー入力のための構造体
typedef struct controller {
float LX, LY, RX, RY;
int A,B,C,D,E,F,G,H;
int fail_safe;
} controller;
