aboutsummaryrefslogtreecommitdiffstats
path: root/Software/Embedded_SW/Embedded/Modules/Thread/Thread.h
blob: 3e2a6aa4028cc032e46f6397ecbb00f17cdef3d4 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
#ifndef MODULES_THREAD_THREAD_H_
#define MODULES_THREAD_THREAD_H_

#include "PMR/common/MessageContainer.pb-c.h"
#include "PMR/Hardware/HardwareMotor.pb-c.h"
#include "PMR/Hardware/HardwareMotorType.pb-c.h"
#include "PMR/Hardware/HardwareDancer.pb-c.h"
#include "PMR/Hardware/HardwareDancerType.pb-c.h"
#include "PMR/Hardware/HardwareWinder.pb-c.h"
#include "PMR/Hardware/HardwarePidControl.pb-c.h"
#include "PMR/Printing/JobSpool.pb-c.h"
#include "PMR/Printing/JobSpoolType.pb-c.h"

#include "drivers/Motors/Motor.h"
#include "../control/pidalgo.h"

#include "thread_ex.h"

typedef struct
{
    uint32_t startoffsetpulses;
    uint32_t spoolbackingrate;
    uint32_t segmentoffsetpulses;// the spool winding initial length in mm
    uint32_t milimetersperrotation;
    uint32_t SpoolBottomBackingRate;// the angle of the bottom of the spool
    double NumberOfRotationPerPassage;  // how many rotations per spool passage
    double diameter;
}InternalWinderConfigStruc;
typedef struct
{
    bool                m_isEnabled;
    int32_t             m_SetParam;
    float               m_mesuredParam;
    float               m_preError;
    float               m_integral;
    float               m_calculatedError;
    bool                m_isReady;
    uint32_t            m_ingnoreValue;
    PID_Config_Params   m_params;
}MotorControlConfig_t;


#define MAX_THREAD_FEED_MOTORS WINDER_MOTOR+1
#define MAX_SYSTEM_DANCERS HARDWARE_DANCER_TYPE__RightDancer+1

extern TimerMotors_t ThreadMotorIdToMotorId[MAX_THREAD_MOTORS_NUM];
extern HardwareDancerType ThreadMotorIdToDancerId[MAX_THREAD_MOTORS_NUM];
extern HardwarePidControlType ThreadMotorIdToControlId[MAX_THREAD_MOTORS_NUM];

extern bool BreakSensorenabled;
extern int32_t BreakSensordebouncetimemilli;

//extern MotorDriverConfigStruc                MotorsCfg[NUM_OF_MOTORS];
extern HardwarePidControl           MotorsControl[MAX_THREAD_MOTORS_NUM];
//extern InternalWinderConfigStruc    InternalWinderCfg;
extern HardwareDancer               DancersCfg[MAX_SYSTEM_DANCERS];
extern uint32_t CurrentControlledSpeed[MAX_THREAD_MOTORS_NUM];
extern int OriginalMotorSpd_2PPS[MAX_THREAD_MOTORS_NUM];

#define MAX_CONTROL_SAMPLES 10
extern int32_t MotorSamples[MAX_THREAD_MOTORS_NUM][MAX_CONTROL_SAMPLES];
extern int MotorSamplePointer[MAX_THREAD_MOTORS_NUM];
extern double NormalizedErrorCoEfficient[MAX_THREAD_MOTORS_NUM];
extern int DancerStopActivityLimit[MAX_THREAD_MOTORS_NUM];
extern    MotorControlConfig_t MotorControlConfig[MAX_THREAD_MOTORS_NUM];
extern int32_t MotorSpeedSamples[MAX_THREAD_MOTORS_NUM][MAX_CONTROL_SAMPLES];
extern int MotorSpeedSamplePointer[MAX_THREAD_MOTORS_NUM];


uint32_t InternalWinderConfigMessage(HardwareWinder* request);
uint32_t MotorsConfigMessage(HardwareMotor * request);
uint32_t InternalWindingConfigMessage(JobSpool* request);
uint32_t ThreadInitialTestStub(HardwareMotor * request);
uint32_t MotorPidRequestMessage(HardwarePidControl* request);

uint32_t DancerConfigMessage(HardwareDancer * request);

void SetOriginMotorSpeed(float process_speed);

#endif //MODULES_THREAD_THREAD_H_
udio.Common.StudioApplication; using Tango.PMR.Diagnostics; using Tango.Integration.Operation; namespace Tango.MachineStudio.Common.EventLogging { /// <summary> /// Represents the default database events logger. /// </summary> /// <seealso cref="IEventLogger" /> public class DefaultEventLogger : ExtendedObject, IEventLogger { private ObservablesContext _db; private Thread _logThread; private ConcurrentQueue<MachinesEvent> _events; private IStudioApplicationManager _application; private IAuthenticationProvider _authentication; private Dictionary<EventTypes, BL.Entities.EventType> _eventTypesGuids; private String _hostName; private bool _isInitialized; private List<MachinesEvent> _pendingEvents; #region Events /// <summary> /// Occurs when a new machine event has been logged. /// </summary> public event EventHandler<MachinesEvent> NewLog; #endregion #region Constructors /// <summary> /// Initializes a new instance of the <see cref="DefaultEventLogger"/> class. /// </summary> /// <param name="applicationManager">The application manager.</param> /// <param name="authenticationProvider">The authentication provider.</param> public DefaultEventLogger(IStudioApplicationManager applicationManager, IAuthenticationProvider authenticationProvider) { _hostName = Environment.MachineName; _events = new ConcurrentQueue<MachinesEvent>(); _pendingEvents = new List<MachinesEvent>(); _eventTypesGuids = new Dictionary<EventTypes, BL.Entities.EventType>(); _application = applicationManager; _authentication = authenticationProvider; _logThread = new Thread(LogThreadMethod); _logThread.IsBackground = true; _logThread.Start(); _application.ConnectedMachineChanged += _application_ConnectedMachineChanged; } #endregion #region Private Methods private void Init() { if (!_isInitialized) { try { _db = ObservablesContext.CreateDefault(); _db.ActionTypes.ToList(); _db.EventTypesActions.ToList(); _db.EventTypesCategories.ToList(); _db.EventTypesGroups.ToList(); _db.EventTypes.ToList(); foreach (var type in _db.EventTypes) { _eventTypesGuids.Add((EventTypes)type.Code, type); } _isInitialized = true; } catch { _isInitialized = false; } } } #endregion #region Event Handlers /// <summary> /// Handle the application manager connected machine changed event. /// </summary> /// <param name="sender">The sender.</param> /// <param name="machine">The machine.</param> private void _application_ConnectedMachineChanged(object sender, IExternalBridgeClient machine) { if (machine != null) { if (machine.MachineEventsStateProvider != null) { machine.MachineEventsStateProvider.NewEvents -= MachineEventsStateProvider_NewEvents; machine.MachineEventsStateProvider.NewEvents += MachineEventsStateProvider_NewEvents; machine.MachineEventsStateProvider.EventsResolved -= MachineEventsStateProvider_EventsResolved; machine.MachineEventsStateProvider.EventsResolved += MachineEventsStateProvider_EventsResolved; } machine.RequestSent -= Machine_RequestSent; machine.RequestFailed -= Machine_RequestFailed; machine.ResponseReceived -= Machine_ResponseReceived; machine.RequestSent += Machine_RequestSent; machine.RequestFailed += Machine_RequestFailed; machine.ResponseReceived += Machine_ResponseReceived; } } /// <summary> /// Handles the RequestSent event of the connected machine. /// </summary> /// <param name="sender">The sender.</param> /// <param name="message">The message.</param> private void Machine_RequestSent(object sender, IMessage message) { Log(EventTypes.RequestSent, String.Format("Sending request '{0}'...{1}{2}", message.GetType().Name, Environment.NewLine, message.ToJsonString())); } /// <summary> /// Handles the RequestFailed event of the connected machine. /// </summary> /// <param name="sender">The source of the event.</param> /// <param name="e">The <see cref="RequestFailedEventArgs"/> instance containing the event data.</param> private void Machine_RequestFailed(object sender, RequestFailedEventArgs e) { Log(EventTypes.RequestFailed, String.Format("Request failed '{0}'...{1}{2}{1}{3}", e.Message.GetType().Name, Environment.NewLine, e.Message.ToJsonString(), e.Exception.ToString())); } /// <summary> /// Handles the ResponseReceived event of the connected machine. /// </summary> /// <param name="sender">The sender.</param> /// <param name="message">The message.</param> private void Machine_ResponseReceived(object sender, IMessage message) { Log(EventTypes.ResponseReceived, String.Format("Response received '{0}'...{1}{2}", message.GetType().Name, Environment.NewLine, message.ToJsonString())); } /// <summary> /// Handles the connected machine events state provider NewEvents event. /// </summary> /// <param name="sender">The sender.</param> /// <param name="events">The events.</param> private void MachineEventsStateProvider_NewEvents(object sender, IEnumerable<MachinesEvent> events) { foreach (var ev in events) { Log(ev); } } /// <summary> /// Handles the connected machine events state provider EventsResolved event. /// </summary> /// <param name="sender">The sender.</param> /// <param name="events">The events.</param> private void MachineEventsStateProvider_EventsResolved(object sender, IEnumerable<MachinesEvent> events) { foreach (var ev in events) { Log(String.Format("Event '{0}' resolved.", ev.EventType.Name)); } } #endregion #region Logging /// <summary> /// Logs the specified machine event. /// </summary> /// <param name="machineEvent">The machine event.</param> public void Log(MachinesEvent machineEvent) { machineEvent.HostName = _hostName; machineEvent.EventType = _eventTypesGuids[machineEvent.Type]; if (_application.ConnectedMachine == null || _authentication.CurrentUser == null) { _pendingEvents.Add(machineEvent); } else { if (_pendingEvents.Count > 0) { var pending = _pendingEvents.ToList(); _pendingEvents.Clear(); foreach (var ev in pending) { Log(ev); } } LogManager.Log("Logging event " + machineEvent.EventType.Name + " - " + machineEvent.Description); machineEvent.MachineGuid = _application.Machine.Guid; machineEvent.UserGuid = _authentication.CurrentUser.Guid; machineEvent.User = _authentication.CurrentUser; _events.Enqueue(machineEvent); NewLog?.Invoke(this, machineEvent); } } /// <summary> /// Logs the specified event type. /// </summary> /// <param name="eventType">Type of the event.</param> /// <param name="message">The message.</param> public void Log(EventTypes eventType, string message, bool write_to_db = true) { Init(); MachinesEvent machineEvent = new MachinesEvent(); machineEvent.DateTime = DateTime.UtcNow; machineEvent.Description = message; machineEvent.EventType = _eventTypesGuids[eventType]; machineEvent.EventTypeGuid = machineEvent.EventType.Guid; if (write_to_db) { Log(machineEvent); } else { NewLog?.Invoke(this, machineEvent); } } /// <summary> /// Logs the specified hardware event. /// </summary> /// <param name="hardwareEvent">The hardware event.</param> public void Log(Event hardwareEvent) { Log((EventTypes)hardwareEvent.Type, hardwareEvent.Message); } /// <summary> /// Logs the specified exception using the <see cref="EventTypes.ApplicationException"/>. /// </summary> /// <param name="exception">The exception.</param> public void Log(Exception exception) { Log(EventTypes.ApplicationException, exception.ToString()); } /// <summary> /// Logs the specified exception using the <see cref="EventTypes.ApplicationException" />. /// </summary> /// <param name="exception">The exception.</param> /// <param name="description"></param> public void Log(Exception exception, string description) { Log(EventTypes.ApplicationException, description + Environment.NewLine + exception.ToString()); } /// <summary> /// Logs the specified message using the <see cref="EventTypes.ApplicationInformation"/>. /// </summary> /// <param name="message">The message.</param> public void Log(String message) { Log(EventTypes.ApplicationInformation, message); } /// <summary> /// Logging thread loop. /// </summary> private void LogThreadMethod() { while (true) { FlushAll(); Thread.Sleep(5000); } } /// <summary> /// Immediately saves all pending events to database. /// </summary> public void FlushAll() { bool _saveChanges = false; while (_events.Count > 0) { MachinesEvent ev = null; if (_events.TryDequeue(out ev)) { ev.User = null; _db.MachinesEvents.Add(ev); _saveChanges = true; } } if (_saveChanges) { try { _db.SaveChanges(); } catch (Exception ex) { LogManager.Log(ex, "Error saving machine event to database."); } } } #endregion } }