yezhong yezhong / yezhong_main_controller_copy_3_

1233

Dependencies:   cJSON_lib mcp2515- mbed-dev-f303 esp8266 yezhong_main_controller_copy_3

math_ops/math_ops.cpp@0:e923de71caa5, 2022-06-24 (annotated)

Committer:
yezhong
Date:
Fri Jun 24 07:58:26 2022 +0000
Revision:
0:e923de71caa5
111111

Who changed what in which revision?

UserRevisionLine numberNew contents of line
yezhong 0:e923de71caa5 1
yezhong 0:e923de71caa5 2 #include "math_ops.h"
yezhong 0:e923de71caa5 3
yezhong 0:e923de71caa5 4
yezhong 0:e923de71caa5 5 float fmaxf(float x, float y){
yezhong 0:e923de71caa5 6 /// Returns maximum of x, y ///
yezhong 0:e923de71caa5 7 return (((x)>(y))?(x):(y));
yezhong 0:e923de71caa5 8 }
yezhong 0:e923de71caa5 9
yezhong 0:e923de71caa5 10 float fminf(float x, float y){
yezhong 0:e923de71caa5 11 /// Returns minimum of x, y ///
yezhong 0:e923de71caa5 12 return (((x)<(y))?(x):(y));
yezhong 0:e923de71caa5 13 }
yezhong 0:e923de71caa5 14
yezhong 0:e923de71caa5 15 float fmaxf3(float x, float y, float z){
yezhong 0:e923de71caa5 16 /// Returns maximum of x, y, z ///
yezhong 0:e923de71caa5 17 return (x > y ? (x > z ? x : z) : (y > z ? y : z));
yezhong 0:e923de71caa5 18 }
yezhong 0:e923de71caa5 19
yezhong 0:e923de71caa5 20 float fminf3(float x, float y, float z){
yezhong 0:e923de71caa5 21 /// Returns minimum of x, y, z ///
yezhong 0:e923de71caa5 22 return (x < y ? (x < z ? x : z) : (y < z ? y : z));
yezhong 0:e923de71caa5 23 }
yezhong 0:e923de71caa5 24
yezhong 0:e923de71caa5 25 void limit_norm(float *x, float *y, float limit){
yezhong 0:e923de71caa5 26 /// Scales the lenght of vector (x, y) to be <= limit ///
yezhong 0:e923de71caa5 27 float norm = sqrt(*x * *x + *y * *y);
yezhong 0:e923de71caa5 28 if(norm > limit){
yezhong 0:e923de71caa5 29 *x = *x * limit/norm;
yezhong 0:e923de71caa5 30 *y = *y * limit/norm;
yezhong 0:e923de71caa5 31 }
yezhong 0:e923de71caa5 32 }
yezhong 0:e923de71caa5 33
yezhong 0:e923de71caa5 34
yezhong 0:e923de71caa5 35 int float_to_uint(float x, float x_min, float x_max, int bits){
yezhong 0:e923de71caa5 36 /// Converts a float to an unsigned int, given range and number of bits ///
yezhong 0:e923de71caa5 37 float span = x_max - x_min;
yezhong 0:e923de71caa5 38 float offset = x_min;
yezhong 0:e923de71caa5 39 return (int) ((x-offset)*((float)((1<<bits)-1))/span);
yezhong 0:e923de71caa5 40 }
yezhong 0:e923de71caa5 41
yezhong 0:e923de71caa5 42
yezhong 0:e923de71caa5 43 float uint_to_float(int x_int, float x_min, float x_max, int bits){
yezhong 0:e923de71caa5 44 /// converts unsigned int to float, given range and number of bits ///
yezhong 0:e923de71caa5 45 float span = x_max - x_min;
yezhong 0:e923de71caa5 46 float offset = x_min;
yezhong 0:e923de71caa5 47 return ((float)x_int)*span/((float)((1<<bits)-1)) + offset;
yezhong 0:e923de71caa5 48 }