major overhaul for when mistake was found with motor inertia modeling