Add another signal for angular acceleration
Correct indexes for angular velocity reconstruction