Files
bizhang_-obav/posix-configs/SITL/init/rcS_lpe_gazebo

67 lines
1.7 KiB
Plaintext
Raw Normal View History

2015-10-24 10:57:46 -04:00
uorb start
simulator start -s
param load
param set MAV_TYPE 2
2015-10-26 16:03:22 -04:00
param set MC_PITCHRATE_P 0.3
param set MC_ROLLRATE_P 0.3
2015-10-24 10:57:46 -04:00
param set MC_YAW_P 2.0
param set MC_YAWRATE_P 0.35
param set SYS_AUTOSTART 4010
param set SYS_RESTART_TYPE 2
dataman start
param set CAL_GYRO0_ID 2293760
param set CAL_ACC0_ID 1376256
param set CAL_ACC1_ID 1310720
param set CAL_MAG0_ID 196608
param set CAL_GYRO0_XOFF 0.01
2015-10-26 16:03:22 -04:00
param set CAL_ACC0_XOFF 1
param set CAL_ACC0_YOFF 2
param set CAL_ACC0_ZOFF 3
2015-10-24 10:57:46 -04:00
param set CAL_ACC0_XSCALE 1.01
param set CAL_ACC0_YSCALE 1.01
param set CAL_ACC0_ZSCALE 1.01
param set CAL_ACC1_XOFF 0.01
param set CAL_MAG0_XOFF 0.01
2015-10-26 16:03:22 -04:00
param set MPC_XY_P 0.15
param set MPC_XY_VEL_P 0.05
2015-10-24 10:57:46 -04:00
param set MPC_XY_VEL_D 0.005
2015-10-26 16:03:22 -04:00
param set MPC_XY_FF 0.1
param set SENS_BOARD_ROT 8
2015-10-24 10:57:46 -04:00
# changes for LPE
param set COM_RC_IN_MODE 1
param set LPE_BETA_MAX 10000
rgbled start
tone_alarm start
gyrosim start
accelsim start
barosim start
adcsim start
gpssim start
pwm_out_sim mode_pwm
sleep 1
sensors start
commander start
land_detector start multicopter
navigator start
attitude_estimator_q start
mc_pos_control start
mc_att_control start
2015-10-26 16:03:22 -04:00
mixer load /dev/pwm_output0 ../../../../ROMFS/px4fmu_common/mixers/quad_w.main.mix
2015-10-24 10:57:46 -04:00
mavlink start -u 14556 -r 2000000
mavlink stream -r 80 -s POSITION_TARGET_LOCAL_NED -u 14556
mavlink stream -r 80 -s LOCAL_POSITION_NED_COV -u 14556
mavlink stream -r 80 -s GLOBAL_POSITION_INT -u 14556
mavlink stream -r 80 -s ATTITUDE -u 14556
mavlink stream -r 80 -s ATTITUDE_TARGET -u 14556
mavlink stream -r 20 -s RC_CHANNELS -u 14556
mavlink stream -r 250 -s HIGHRES_IMU -u 14556
mavlink stream -r 10 -s OPTICAL_FLOW_RAD -u 14556
mavlink boot_complete
sdlog2 start -r 100 -e -t -a
# start LPE at end, when we know it is ok to init sensors
sleep 5
local_position_estimator start