| 1 | // Copyright (C) 2017 Klaralvdalens Datakonsult AB (KDAB). |
| 2 | // SPDX-License-Identifier: LicenseRef-Qt-Commercial OR LGPL-3.0-only OR GPL-2.0-only OR GPL-3.0-only |
| 3 | |
| 4 | #include "fcurve_p.h" |
| 5 | #include <private/bezierevaluator_p.h> |
| 6 | |
| 7 | #include <QtCore/qjsonarray.h> |
| 8 | #include <QtCore/qjsonobject.h> |
| 9 | #include <QtCore/QLatin1String> |
| 10 | |
| 11 | QT_BEGIN_NAMESPACE |
| 12 | |
| 13 | namespace Qt3DAnimation { |
| 14 | namespace Animation { |
| 15 | |
| 16 | FCurve::FCurve() |
| 17 | : m_rangeFinder(&m_localTimes) |
| 18 | { |
| 19 | } |
| 20 | |
| 21 | float FCurve::evaluateAtTime(float localTime) const |
| 22 | { |
| 23 | return evaluateAtTime(localTime, lowerBound: lowerKeyframeBound(localTime)); |
| 24 | } |
| 25 | |
| 26 | |
| 27 | float FCurve::evaluateAtTime(float localTime, int lowerBound) const |
| 28 | { |
| 29 | // TODO: Implement extrapolation beyond first/last keyframes |
| 30 | if (localTime < m_localTimes.first()) { |
| 31 | return m_keyframes.first().value; |
| 32 | } else if (localTime > m_localTimes.last()) { |
| 33 | return m_keyframes.last().value; |
| 34 | } else { |
| 35 | // Find keyframes that sandwich the requested localTime |
| 36 | if (lowerBound < 0) // only one keyframe |
| 37 | return m_keyframes.first().value; |
| 38 | |
| 39 | const float t0 = m_localTimes[lowerBound]; |
| 40 | const float t1 = m_localTimes[lowerBound + 1]; |
| 41 | const Keyframe &keyframe0(m_keyframes[lowerBound]); |
| 42 | const Keyframe &keyframe1(m_keyframes[lowerBound + 1]); |
| 43 | |
| 44 | switch (keyframe0.interpolation) { |
| 45 | case QKeyFrame::ConstantInterpolation: |
| 46 | return keyframe0.value; |
| 47 | case QKeyFrame::LinearInterpolation: |
| 48 | if (localTime >= t0 && localTime <= t1 && t1 > t0) { |
| 49 | float t = (localTime - t0) / (t1 - t0); |
| 50 | return (1 - t) * keyframe0.value + t * keyframe1.value; |
| 51 | } |
| 52 | break; |
| 53 | case QKeyFrame::BezierInterpolation: |
| 54 | { |
| 55 | BezierEvaluator evaluator(t0, keyframe0, t1, keyframe1); |
| 56 | return evaluator.valueForTime(time: localTime); |
| 57 | } |
| 58 | default: |
| 59 | qWarning(msg: "Unknown interpolation type %d" , keyframe0.interpolation); |
| 60 | break; |
| 61 | } |
| 62 | } |
| 63 | |
| 64 | return m_keyframes.first().value; |
| 65 | } |
| 66 | |
| 67 | float FCurve::evaluateAtTimeAsSlerp(float localTime, int lowerBound, float halfTheta, float sinHalfTheta, float reverseQ1) const |
| 68 | { |
| 69 | // TODO: Implement extrapolation beyond first/last keyframes |
| 70 | if (localTime < m_localTimes.first()) |
| 71 | return m_keyframes.first().value; |
| 72 | |
| 73 | if (localTime > m_localTimes.last()) |
| 74 | return m_keyframes.last().value; |
| 75 | // Find keyframes that sandwich the requested localTime |
| 76 | if (lowerBound < 0) // only one keyframe |
| 77 | return m_keyframes.first().value; |
| 78 | |
| 79 | const float t0 = m_localTimes[lowerBound]; |
| 80 | const float t1 = m_localTimes[lowerBound + 1]; |
| 81 | const Keyframe &keyframe0(m_keyframes[lowerBound]); |
| 82 | const Keyframe &keyframe1(m_keyframes[lowerBound + 1]); |
| 83 | |
| 84 | switch (keyframe0.interpolation) { |
| 85 | case QKeyFrame::ConstantInterpolation: |
| 86 | return keyframe0.value; |
| 87 | case QKeyFrame::LinearInterpolation: |
| 88 | if (localTime >= t0 && localTime <= t1 && t1 > t0) { |
| 89 | const auto t = (localTime - t0) / (t1 - t0); |
| 90 | |
| 91 | const auto A = std::sin(x: (1.0f-t) * halfTheta) / sinHalfTheta; |
| 92 | const auto B = std::sin(x: t * halfTheta) / sinHalfTheta; |
| 93 | return A * keyframe0.value + reverseQ1 * B * keyframe1.value; |
| 94 | } |
| 95 | break; |
| 96 | case QKeyFrame::BezierInterpolation: |
| 97 | // TODO implement a proper slerp bezier interpolation |
| 98 | BezierEvaluator evaluator(t0, keyframe0, t1, keyframe1); |
| 99 | return evaluator.valueForTime(time: localTime); |
| 100 | } |
| 101 | |
| 102 | return m_keyframes.first().value; |
| 103 | } |
| 104 | |
| 105 | int FCurve::lowerKeyframeBound(float localTime) const |
| 106 | { |
| 107 | if (localTime < m_localTimes.first()) |
| 108 | return 0; |
| 109 | if (localTime > m_localTimes.last()) |
| 110 | return 0; |
| 111 | return m_rangeFinder.findLowerBound(x: localTime); |
| 112 | } |
| 113 | |
| 114 | float FCurve::startTime() const |
| 115 | { |
| 116 | if (!m_localTimes.isEmpty()) |
| 117 | return m_localTimes.first(); |
| 118 | return 0.0f; |
| 119 | } |
| 120 | |
| 121 | float FCurve::endTime() const |
| 122 | { |
| 123 | if (!m_localTimes.isEmpty()) |
| 124 | return m_localTimes.last(); |
| 125 | return 0.0f; |
| 126 | } |
| 127 | |
| 128 | void FCurve::appendKeyframe(float localTime, const Keyframe &keyframe) |
| 129 | { |
| 130 | m_localTimes.append(t: localTime); |
| 131 | m_keyframes.append(t: keyframe); |
| 132 | } |
| 133 | |
| 134 | void FCurve::read(const QJsonObject &json) |
| 135 | { |
| 136 | clearKeyframes(); |
| 137 | |
| 138 | const QJsonArray keyframeArray = json[QLatin1String("keyFrames" )].toArray(); |
| 139 | const qsizetype keyframeCount = keyframeArray.size(); |
| 140 | |
| 141 | for (int i = 0; i < keyframeCount; ++i) { |
| 142 | const QJsonObject keyframeData = keyframeArray.at(i).toObject(); |
| 143 | |
| 144 | // Extract the keyframe local time and value |
| 145 | const QJsonArray keyframeCoords = keyframeData[QLatin1String("coords" )].toArray(); |
| 146 | float localTime = keyframeCoords.at(i: 0).toDouble(); |
| 147 | |
| 148 | Keyframe keyframe; |
| 149 | keyframe.value = keyframeCoords.at(i: 1).toDouble(); |
| 150 | |
| 151 | if (keyframeData.contains(key: QLatin1String("leftHandle" ))) { |
| 152 | keyframe.interpolation = QKeyFrame::BezierInterpolation; |
| 153 | |
| 154 | const QJsonArray leftHandle = keyframeData[QLatin1String("leftHandle" )].toArray(); |
| 155 | keyframe.leftControlPoint[0] = leftHandle.at(i: 0).toDouble(); |
| 156 | keyframe.leftControlPoint[1] = leftHandle.at(i: 1).toDouble(); |
| 157 | |
| 158 | const QJsonArray rightHandle = keyframeData[QLatin1String("rightHandle" )].toArray(); |
| 159 | keyframe.rightControlPoint[0] = rightHandle.at(i: 0).toDouble(); |
| 160 | keyframe.rightControlPoint[1] = rightHandle.at(i: 1).toDouble(); |
| 161 | } else { |
| 162 | keyframe.interpolation = QKeyFrame::LinearInterpolation; |
| 163 | } |
| 164 | |
| 165 | appendKeyframe(localTime, keyframe); |
| 166 | } |
| 167 | |
| 168 | // TODO: Ensure beziers have no loops or cusps by scaling the control points |
| 169 | // back so they do not interset. |
| 170 | } |
| 171 | |
| 172 | void FCurve::setFromQChannelComponent(const QChannelComponent &qcc) |
| 173 | { |
| 174 | clearKeyframes(); |
| 175 | |
| 176 | for (const auto &frontendKeyFrame : qcc) { |
| 177 | // Extract the keyframe local time and value |
| 178 | const float localTime = frontendKeyFrame.coordinates()[0]; |
| 179 | |
| 180 | Keyframe keyFrame; |
| 181 | keyFrame.interpolation = frontendKeyFrame.interpolationType(); |
| 182 | keyFrame.value = frontendKeyFrame.coordinates()[1]; |
| 183 | keyFrame.leftControlPoint = frontendKeyFrame.leftControlPoint(); |
| 184 | keyFrame.rightControlPoint = frontendKeyFrame.rightControlPoint(); |
| 185 | appendKeyframe(localTime, keyframe: keyFrame); |
| 186 | } |
| 187 | |
| 188 | // TODO: Ensure beziers have no loops or cusps by scaling the control points |
| 189 | // back so they do not interset. |
| 190 | } |
| 191 | |
| 192 | void ChannelComponent::read(const QJsonObject &json) |
| 193 | { |
| 194 | name = json[QLatin1String("channelComponentName" )].toString(); |
| 195 | fcurve.read(json); |
| 196 | } |
| 197 | |
| 198 | void ChannelComponent::setFromQChannelComponent(const QChannelComponent &qcc) |
| 199 | { |
| 200 | name = qcc.name(); |
| 201 | fcurve.setFromQChannelComponent(qcc); |
| 202 | } |
| 203 | |
| 204 | void Channel::read(const QJsonObject &json) |
| 205 | { |
| 206 | name = json[QLatin1String("channelName" )].toString(); |
| 207 | const auto jointIndexValue = json[QLatin1String("jointIndex" )]; |
| 208 | if (!jointIndexValue.isUndefined()) |
| 209 | jointIndex = jointIndexValue.toInt(); |
| 210 | const QJsonArray channelComponentsArray = json[QLatin1String("channelComponents" )].toArray(); |
| 211 | const qsizetype channelCount = channelComponentsArray.size(); |
| 212 | channelComponents.resize(size: channelCount); |
| 213 | |
| 214 | for (qsizetype i = 0; i < channelCount; ++i) { |
| 215 | const QJsonObject channel = channelComponentsArray.at(i).toObject(); |
| 216 | channelComponents[i].read(json: channel); |
| 217 | } |
| 218 | } |
| 219 | |
| 220 | void Channel::setFromQChannel(const QChannel &qch) |
| 221 | { |
| 222 | name = qch.name(); |
| 223 | jointIndex = qch.jointIndex(); |
| 224 | channelComponents.resize(size: qch.channelComponentCount()); |
| 225 | qsizetype i = 0; |
| 226 | for (const auto &frontendChannelComponent : qch) |
| 227 | channelComponents[i++].setFromQChannelComponent(frontendChannelComponent); |
| 228 | } |
| 229 | |
| 230 | } // namespace Animation |
| 231 | } // namespace Qt3DAnimation |
| 232 | |
| 233 | QT_END_NAMESPACE |
| 234 | |