You can not select more than 25 topics
			Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
		
		
		
		
			
				
					204 lines
				
				4.2 KiB
			
		
		
			
		
	
	
					204 lines
				
				4.2 KiB
			| 
								 
											8 years ago
										 
									 | 
							
								#include <stdint.h>
							 | 
						||
| 
								 | 
							
								#include <stdbool.h>
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								typedef struct
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  uint32_t TIR;  /*!< CAN TX mailbox identifier register */
							 | 
						||
| 
								 | 
							
								  uint32_t TDTR; /*!< CAN mailbox data length control and time stamp register */
							 | 
						||
| 
								 | 
							
								  uint32_t TDLR; /*!< CAN mailbox data low register */
							 | 
						||
| 
								 | 
							
								  uint32_t TDHR; /*!< CAN mailbox data high register */
							 | 
						||
| 
								 | 
							
								} CAN_TxMailBox_TypeDef;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								typedef struct
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  uint32_t RIR;  /*!< CAN receive FIFO mailbox identifier register */
							 | 
						||
| 
								 | 
							
								  uint32_t RDTR; /*!< CAN receive FIFO mailbox data length control and time stamp register */
							 | 
						||
| 
								 | 
							
								  uint32_t RDLR; /*!< CAN receive FIFO mailbox data low register */
							 | 
						||
| 
								 | 
							
								  uint32_t RDHR; /*!< CAN receive FIFO mailbox data high register */
							 | 
						||
| 
								 | 
							
								} CAN_FIFOMailBox_TypeDef;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								typedef struct
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								  uint32_t CNT;
							 | 
						||
| 
								 | 
							
								} TIM_TypeDef;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								struct sample_t toyota_torque_meas;
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								struct sample_t cadillac_torque_driver;
							 | 
						||
| 
								 | 
							
								struct sample_t gm_torque_driver;
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								struct sample_t hyundai_torque_driver;
							 | 
						||
| 
								 
											8 years ago
										 
									 | 
							
								
							 | 
						||
| 
								 | 
							
								TIM_TypeDef timer;
							 | 
						||
| 
								 | 
							
								TIM_TypeDef *TIM2 = &timer;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#define min(a,b)                                \
							 | 
						||
| 
								 | 
							
								  ({ __typeof__ (a) _a = (a);                   \
							 | 
						||
| 
								 | 
							
								    __typeof__ (b) _b = (b);                    \
							 | 
						||
| 
								 | 
							
								    _a < _b ? _a : _b; })
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#define max(a,b)                                \
							 | 
						||
| 
								 | 
							
								  ({ __typeof__ (a) _a = (a);                   \
							 | 
						||
| 
								 | 
							
								    __typeof__ (b) _b = (b);                    \
							 | 
						||
| 
								 | 
							
								    _a > _b ? _a : _b; })
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#define PANDA
							 | 
						||
| 
								 | 
							
								#define static
							 | 
						||
| 
								 | 
							
								#include "safety.h"
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void set_controls_allowed(int c){
							 | 
						||
| 
								 | 
							
								  controls_allowed = c;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void reset_angle_control(void){
							 | 
						||
| 
								 | 
							
								  angle_control = 0;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								int get_controls_allowed(void){
							 | 
						||
| 
								 | 
							
								  return controls_allowed;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void set_timer(int t){
							 | 
						||
| 
								 | 
							
								  timer.CNT = t;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_toyota_torque_meas(int min, int max){
							 | 
						||
| 
								 | 
							
								  toyota_torque_meas.min = min;
							 | 
						||
| 
								 | 
							
								  toyota_torque_meas.max = max;
							 | 
						||
| 
								 
											8 years ago
										 
									 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_cadillac_torque_driver(int min, int max){
							 | 
						||
| 
								 | 
							
								  cadillac_torque_driver.min = min;
							 | 
						||
| 
								 | 
							
								  cadillac_torque_driver.max = max;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void set_gm_torque_driver(int min, int max){
							 | 
						||
| 
								 | 
							
								  gm_torque_driver.min = min;
							 | 
						||
| 
								 | 
							
								  gm_torque_driver.max = max;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_hyundai_torque_driver(int min, int max){
							 | 
						||
| 
								 | 
							
								  hyundai_torque_driver.min = min;
							 | 
						||
| 
								 | 
							
								  hyundai_torque_driver.max = max;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								int get_toyota_torque_meas_min(void){
							 | 
						||
| 
								 | 
							
								  return toyota_torque_meas.min;
							 | 
						||
| 
								 
											8 years ago
										 
									 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								int get_toyota_torque_meas_max(void){
							 | 
						||
| 
								 | 
							
								  return toyota_torque_meas.max;
							 | 
						||
| 
								 
											8 years ago
										 
									 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_toyota_rt_torque_last(int t){
							 | 
						||
| 
								 | 
							
								  toyota_rt_torque_last = t;
							 | 
						||
| 
								 
											8 years ago
										 
									 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_cadillac_rt_torque_last(int t){
							 | 
						||
| 
								 | 
							
								  cadillac_rt_torque_last = t;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void set_gm_rt_torque_last(int t){
							 | 
						||
| 
								 | 
							
								  gm_rt_torque_last = t;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_hyundai_rt_torque_last(int t){
							 | 
						||
| 
								 | 
							
								  hyundai_rt_torque_last = t;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_toyota_desired_torque_last(int t){
							 | 
						||
| 
								 | 
							
								  toyota_desired_torque_last = t;
							 | 
						||
| 
								 
											8 years ago
										 
									 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_cadillac_desired_torque_last(int t){
							 | 
						||
| 
								 | 
							
								  for (int i = 0; i < 4; i++) cadillac_desired_torque_last[i] = t;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void set_gm_desired_torque_last(int t){
							 | 
						||
| 
								 | 
							
								  gm_desired_torque_last = t;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_hyundai_desired_torque_last(int t){
							 | 
						||
| 
								 | 
							
								  hyundai_desired_torque_last = t;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_chrysler_desired_torque_last(int t){
							 | 
						||
| 
								 | 
							
								  chrysler_desired_torque_last = t;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											8 years ago
										 
									 | 
							
								int get_ego_speed(void){
							 | 
						||
| 
								 | 
							
								  return ego_speed;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								int get_brake_prev(void){
							 | 
						||
| 
								 | 
							
								  return brake_prev;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								int get_gas_prev(void){
							 | 
						||
| 
								 | 
							
								  return gas_prev;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void set_honda_alt_brake_msg(bool c){
							 | 
						||
| 
								 | 
							
								  honda_alt_brake_msg = c;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void set_bosch_hardware(bool c){
							 | 
						||
| 
								 | 
							
								  bosch_hardware = c;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											8 years ago
										 
									 | 
							
								void init_tests_toyota(void){
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								  toyota_torque_meas.min = 0;
							 | 
						||
| 
								 | 
							
								  toyota_torque_meas.max = 0;
							 | 
						||
| 
								 | 
							
								  toyota_desired_torque_last = 0;
							 | 
						||
| 
								 | 
							
								  toyota_rt_torque_last = 0;
							 | 
						||
| 
								 | 
							
								  toyota_ts_last = 0;
							 | 
						||
| 
								 
											8 years ago
										 
									 | 
							
								  set_timer(0);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void init_tests_cadillac(void){
							 | 
						||
| 
								 | 
							
								  cadillac_torque_driver.min = 0;
							 | 
						||
| 
								 | 
							
								  cadillac_torque_driver.max = 0;
							 | 
						||
| 
								 | 
							
								  for (int i = 0; i < 4; i++) cadillac_desired_torque_last[i] = 0;
							 | 
						||
| 
								 | 
							
								  cadillac_rt_torque_last = 0;
							 | 
						||
| 
								 | 
							
								  cadillac_ts_last = 0;
							 | 
						||
| 
								 | 
							
								  set_timer(0);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void init_tests_gm(void){
							 | 
						||
| 
								 | 
							
								  gm_torque_driver.min = 0;
							 | 
						||
| 
								 | 
							
								  gm_torque_driver.max = 0;
							 | 
						||
| 
								 | 
							
								  gm_desired_torque_last = 0;
							 | 
						||
| 
								 | 
							
								  gm_rt_torque_last = 0;
							 | 
						||
| 
								 | 
							
								  gm_ts_last = 0;
							 | 
						||
| 
								 | 
							
								  set_timer(0);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void init_tests_hyundai(void){
							 | 
						||
| 
								 | 
							
								  hyundai_torque_driver.min = 0;
							 | 
						||
| 
								 | 
							
								  hyundai_torque_driver.max = 0;
							 | 
						||
| 
								 | 
							
								  hyundai_desired_torque_last = 0;
							 | 
						||
| 
								 | 
							
								  hyundai_rt_torque_last = 0;
							 | 
						||
| 
								 | 
							
								  hyundai_ts_last = 0;
							 | 
						||
| 
								 | 
							
								  set_timer(0);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 
											8 years ago
										 
									 | 
							
								void init_tests_honda(void){
							 | 
						||
| 
								 | 
							
								  ego_speed = 0;
							 | 
						||
| 
								 | 
							
								  gas_interceptor_detected = 0;
							 | 
						||
| 
								 | 
							
								  brake_prev = 0;
							 | 
						||
| 
								 | 
							
								  gas_prev = 0;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								void init_tests_chrysler(void){
							 | 
						||
| 
								 | 
							
								  chrysler_desired_torque_last = 0;
							 | 
						||
| 
								 | 
							
								  set_timer(0);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 
											7 years ago
										 
									 | 
							
								
							 | 
						||
| 
								 | 
							
								void set_gmlan_digital_output(int to_set){
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void reset_gmlan_switch_timeout(void){
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void gmlan_switch_init(int timeout_enable){
							 | 
						||
| 
								 | 
							
								}
							 |