search

kauailabs / navxmxp

Robotics Navigation Sensors. NavX-MXP designed for the National Instruments RoboRIO & FIRST FRC Robotics. Navx-MIcro designed for Android-based FIRST FTC Robots
MIT License
105 stars 89 forks source link

VMX-pi (RegisterIO_Mau) has two issues, impacting yaw reset and calibration status #96

Open kauailabs opened 4 years ago

kauailabs commented 4 years ago

1) In zeroYaw(), this needs to be added:

this.notify_sink.yawResetComplete();

2) In getCurrentData(), this line:

        ahrspos_update.cal_status      = curr_data[IMURegisters.NAVX_REG_CAL_STATUS];

should be instead:

        ahrspos_update.cal_status      = curr_data[IMURegisters.NAVX_REG_CAL_STATUS - **_first_address_**];